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Abstract 

A passivity and Lyapunov based approach for the control design for the trajectory tracking problem of 
flexible joint robots is presented. The basic structure of the proposed controller is the sum of a model- 
based feedforward and a model-independent feedback. Feedforward selection and solution is analyzed 
for a general model for flexible joints, and for more specific and practical model structures. Passivity 
theory is used to design a motor state-based controller in order to input-output stabilize the error system 
formed by the feedforward. Observability conditions for asymptotic stability are stated and verified. In 
order to accommodate for modeling uncertainties and to allow for the implementation of a simplified 
feedforward compensation, the stability of the system is analyzed in presence of approximations in the 
feedforward by using a Lyapunov based robustness analysis. It is shown that under certain conditions, 
e.g. the desired trajectory is varying slowly enough, stability is maintained for various approximations 
of a canonical feedforward. 

* 

1 Introduction 

Joint flexibility is well recognized for its adverse effect on stability and performance of robotic manipula- 
tors [23, 28]. The main implications of joint flexibility are that the number of degrees of freedom is larger 
than the number of inputs, and that the system is not passive from the torque input to the link velocity 
as for rigid robots such that most of the control schemes designed for rigid robots are inappropriate 
for the control of flexible joint robots. Different approaches have been considered to solve the problem 
of controlling robots with joint elasticity including singular perturbation techniques, exact linearization 
and passivity based design. Singular perturbation techniques and exact linearization generally require 
linear spring assumption and exact knowledge of the system parameters, and are characterized by their 
computational complexity and their lack of robustness to parameter uncertainty (for a summary, see 
[27]). Furthermore, exact linearization requires zero gyroscopic force, and the feedforward compensation 
for linearization and the feedback stabilization are intertwined and errors in the feedforward may affect 
the closed loop stability in an adverse way. 

The concept of passivity is traditionally defined as an input/output condition describing a class of physical 
systems that do not generate energy [18]. This property has been used in the feedback stabilization for 
fully actuated rigid robots [29], satellites [6], and flexible joint robots [4, 31]. The passivity property for 
flexible joint robots (motor torque and motor velocity form a passive pair) was recognized in [4] and was 
used in a proportional-derivative (PD) type controller design. The method requires inherent damping in 
both links and motors. Similar results without requiring the inherent damping have recently appeared 
in [31]. The PD controller has been generalized to a general passive controller in [22]. This method also 
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requires inherent damping and furthermore, linear spring assumption. Moreover, a frequency analysis 
that yields a non-causal solution is used to find the feedforward. The design of general passive controllers 
without the requirement of inherent damping and of the linear spring assumption, and that uses causal 
feedforward was presented in [15, 24]. This approach allows to consider both the set point and tracking 
problems, and does not require a large elastic coupling stiffness as singular perturbation techniques does. 

The basic structure of the proposed controller is the sum of a model-based feedforward and a model- 
independent feedback [15, 24]. The feedforward design in the proposed scheme is very similar to the 
exact linearization approach, both essentially solve an inverse plant problem, but requires much less 
model information in the set point control case, and the additive separation between the feedback and 
feedforward implies that errors in the feedforward do not lead to instability. However, the closed loop 
performance cannot be arbitrarily assigned and the feedforward for the tracking problem may be complex. 
We address the issue of computing a causal feedforward for a nonlinear spring. 

Passivity based controllers have been recognized for their robustness to parameter uncertainties [1, 31]. 
This robustness may allow to simplify the control law for implementation as opposed to exact linearization 
techniques for which simplifications may compromise stability. We will analyze the stability of the system 
under feedforward approximations. 

This paper addresses the following trajectory tracking problem for flexible joint robots: 

Given the desired output trajectory described by and its derivatives, t > t 0 , design a feedback 
control law u(i) so that 6{t) tracks 8d(t) in some sense while assuring internal stability of the system. 

In Section 2, background information on passivity, and useful definitions and theorems are provided. In 
Section 3, the model of the class of systems that is considered and some of its properties are presented. 
The proposed approach for controller design which exploits the passivity property of flexible joint robots 
is exposed in Section 4. In Section 5, various possible forms of feedforward for the trajectory tracking 
problem are presented and the issue of solving the feedforward is addressed. In Section 6, the controller 
design is carried out for particular choices of feedforward, referred to as the canonical feedforward com- 
pensation schemes, under the assumption that certain conditions are satisfied. Zero-state detectability 
of the canonical feedforward compensation schemes is analyzed in Section 7. In Section 8, the stability 
of different possible forms of feedforward is analyzed by using a Lyapunov based robustness analysis. 
Conclusions are drawn and future work is summarized in Section 9. 

2 Passivity and definitions 

The notion of passivity of an input-output system, motivated by the dissipation of energy across re- 
sistors in an electrical circuit, has been widely used in order to analyze stability of a general class of 
interconnected nonlinear systems, e.g. [32, 34]. Passivity was also studied for state-space representations 
of nonlinear systems, allowing a more geometric interpretation of notions such as available, stored, and 
dissipated energy in terms of Lyapunov functions [38, 39, 40]. This point of view has been specifically 
developed in [10, 11], and leads to Lyapunov-theoretic counterparts to many stability results developed 
within an input-output perspective, as well as to a nonlinear form of the Kalman-Yacubovitch-Popov 
lemma. The great interest of considering passive (strictly passive) systems lies in the fact that passivity 
is invariant under feedback connections and that passive systems are always stable, and under additional 
assumptions asymptotically stable [17, 18, 38, 41]. 

In [18], necessary and sufficient conditions for a nonlinear autonomous system with the control entering 
linearly to be passive are given. It is well known that passive linear systems are necessarily minimum 
phase and, conversely, a minimum phase plant with relative degree zero or one can be rendered passive 
via astatic state feedback. A similar relationship for nonlinear systems has recently been published [5]. 
This allows to extend the class of systems to which the stability results for passive systems applies. 
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We now present definitions and theorems related to passivity and to the stabilization of passive systems. 
The information presented here was mainly drawn from [5, 10, 11, 18, 33, 38, 39, 41, 42, 43]. Other 
papers of interest that treat positive realness, which is a subcase of passivity, are [2, 12, 37], 

Definition 2.1 [33] A function f : R+ — R n is an element of the vector space I p (R + ,R n ) if 


/ CO 

\f(t)\ P dt< OO 

‘OO 


for p € [1, oo) 


Define the input and output signal spaces, U e , y e , respectively, as the extended spaces L 2e (R+, R n ), i.e. 
the causal extension of £ 2 (R+,R n ) : 

Z 2e (R + ,R n ) i {/ : R+ -*■ R" | Prf € I 2 (R+,R n ),VT € R} 


where Pt is the projection operator that truncates / at T: 


( Prfm = 


f(t) for t < T 
0 otherwise 


Define the truncated inner product by 

<»(•). H0>t = (PM-),Ptv(-)) 2 = r(P T u(t)) T P T v(t)dt 

J o 


By a dynamical system, we mean an I/O mapping H :U e —• y e . The following definitions are given for 
y e being extended L p — spaces, but we will use uniquely L 2 — spaces in the remaining of the report. 

Definition 2.2 [33] For p € [l,oo), the function ||-|| p ; I p [0, oo) — [0,oo) is defined by 



The function H-H^ ; Zoo[0,oo) — *■ [0, oo) is defined by 

11/(01100 = e55 SU P 1/(01 

(€[0,oo) 


Definition 2.3 [33] A dynamical system H is L p -stable if 


(0 y 6 L p whenever u € L p , and 

(ii) There exist finite constants k, b such that 

lly|| P <*IMIp + & 

Definition 2.4 [33] A dynamical system H is Loo-stable (Bounded Input-Bounded Output-stable, BIBO 
stable) if 

(i) y € L p whenever u € L p , and 

(ii) There exist finite constants k, b such that 

IMloo <* IMIco + b 
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Different definitions for passivity, which characterizes systems that do not generate energy, have been used 
[43]. We will adopt one of these definitions, but first will define the more general concept of dissipativity 
[ 10 , 11 ]. 

Definition 2.5 [1 1] A dynamical system H is dissipative with respect to the triplet ( Q,S,R ) if 

w(u, y) = { y , Qy) T + 2 ( y,Su) T + (u, Ru) T > 0 

for all T > 0 and u € U t , where w(u,y ) is defined as the supply rate, and Q, S and R are memoryless 
bounded operators with Q and R self-adjoint. 

Definition 2.6 [43] A dynamical system H storing no energy at t = 0 is passive if for all T 6 R+ and 
all admissible pairs {u(-), j/(-)} € {U e , 34 } , 


(y,u) T > 0 

The quantity { y,u) T is sometimes defined as the input energy of the system [18]. This nomenclature will 
be used here. 

Definition 2.7 [38] A dynamical system H storing no energy at t = 0 is strictly passive if for all T € R+ 
and all admissible pairs {u(-),y(-)} € {U e ,y e }, H - el is passive for some real constant s > 0, i.e. if 

(y, u) T - e (u,u) T > 0 

Hence, a finite-gain I/O stable system is dissipative with respect to (-7,0, k 2 I), while a passive sys- 
tem is dissipative with respect to (0, \l , 0) and a strictly-passive system is dissipative with respect to 
(0, \I, — e) [11]. This definition of strict-passivity corresponds to the definition of U-strong-passivity 
(USP) in [10]. Two additional forms of strong passivity as defined in [10] are Y-strong-passivity (YSP) 
which corresponds to systems that are dissipative with respect to (— £, ^7, 0) for some real constant 
e > 0, and Very-strong-passivity (VSP) which corresponds to systems that are dissipative with respect 
to (— — £ 2 ) for some real constants £1 > 0 and £2 > 0. 

In [38, 39], different energy quantities are defined. The required energy E r is the energy needed to excite 
a system to a given set of initial conditions. The available energy E a is the maximum energy that can be 
extracted from a system. The cycle energy E c is the minimum energy it takes to cycle a system between 
the equilibrium and a given state. Under mild conditions, these quantities are well defined for a passive 
system : 

Lemma 2.1 [38] Consider a realization of a passive system and assume that the state space is reachable. 
Then E a> E r and E c exist (i.e. E a ,E T ,E c < 00 ) and are nonnegative. Moreover, 0 < E a , E c < E r . 

In principle, these quantities can be used to construct Lyapunov functions as illustrated by the following 
theorem. 

Theorem 2.1 [39] The set of possible storage functions of a dissipative dynamical system forms a convex 
set. Hence, aE a + (1 - a)E r , 0 < a < 1, is a possible storage function for a dissipative dynamical system 
whose state space is reachable from the point in space where the storage function attains its minimum. 

An important characteristic of the systems studied here is that they satisfy the following conservation of 
energy equation [17, 18]: 

Input energy = Final energy - Initial energy + Dissipated energy 
where, for passive systems, the dissipated energy is always nonnegative. 
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In [10], a necessary and sufficient condition for a nonlinear system with the control input entering linearly 
to be dissipative is given. The test involves the construction of some functions, including a function 
representing the generalized energy of the system. This function is positive for dissipative systems such 
that this condition can be used as an aid for the construction of a Lyapunov function for the system. 

Input/output and state space stability and stabilization of passive systems have been extensively studied 
, and we now present some of these results, but first provide two more definitions. 

Definition 2.8 A dynamical system H is said to be zero-state detectable if u(t) = 0 and y{t) = 0 imply 
that the state x(t) = 0. 

For linear systems, this corresponds to observability. 

We introduce here a weaker form of zero-state detectability. 

Definition 2.9 A dynamical system H is said to be weakly zero-state detectable if u(t) = 0 and y(t) = 0 
imply that the state x(t) — ► 0 asymptotically . 

There is no consensus actually in the literature about the nomenclature regarding zero-state detectability. 
Hence, in [5], Definition 2.8 corresponds to observability, and Definition 2.9 to zero-state detectability. 

Theorem 2.2 [10] Consider a dynamical system H which is dissipative with respect to the triplet (Q,S,R) 
and zero-detectable . Then, the system with zero input is Lyapunov stable if Q < 0 and asymptotically 
stable if Q < 0. 

Hence, passive and strictly-passive (USP) systems are stable while YSP and VSP systems are asymptot- 
ically stable. 

The same conclusions hold for weakly zero-detectable systems. 

An important characteristic of passivity is that it is invariant under feedback connections [39, 41]. Hence, 
a feedback system consisting of a passive dynamical system in both the feedforward and feedback loop 
is itself passive and thus stable. Moreover, the sum of the stored energies in the forward loop and in the 
feedback loop is a Lyapunov function for the closed loop system. Hence, the Lyapunov function used to 
show passivity of the two system components may be used as part of the overall Lyapunov function used 
to show the stability of the system. This procedure to show stability is formalized in [41], 

We now state a simplified version of a very important theorem in the stabilization of passive systems, 
the Passivity Theorem , which provides sufficient conditions to determine stability of the interconnection 
of systems. 

Theorem 2.3 Passivity Theorem [9]: The system formed by the negative feedback connection of a passive 
dynamical system and of a strictly passive dynamical system with finite gain is L 2 -stable . 

Hence, any passive system can be rendered ^“Stable by closing a strictly passive loop with finite gain. 
I/O stability infers internal state space asymptotic stability if the closed-loop system is stabilizable and 
zero-state detectable (if these properties hold globally, the internal stability is also global). Hence, under 
observability (zero— state detectability) and reachability conditions, the interconnection of a passive and 
a finite gain strictly passive system is asymptotically stable [38, 41]. Also, it is sometimes possible to 
show via a Lyapunov type argument that y(t) — ♦ 0 asymptotically if u(£) s 0. Then the zero-state 
detectability alone guarantees internal asymptotic stability. 

It is well known that passive linear systems are necessarily minimum phase and, conversely, a minimum 
phase plant with relative degree zero or one can be rendered passive via a static state feedback (see [5] 
for a particular form of this statement). A similar relationship for nonlinear systems has recently been 
published in [5]. It is shown that a nonlinear system can be rendered passive via static feedback, i.e. it 
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is feedback equivalent to a passive feedback, if and only if the system is weakly minimum phase and the 
relative degree is one (see Appendix B for the formal statement). An equivalent statement for this is 
that the system is asymptotically stabilizable by state feedback [5]. Hence, the class of systems to which 
stabilization by passivity approach applies can be extended by using this result. 

3 Modeling of flexible joint manipulators 


The dynamical equation of motion for flexibly jointed manipulators with rigid links can be written as: 

M{9)9 + C(9,9)9 + D{9) + r(9) = Bu (3.1) 

r(*) = $(*) + *(*) (3-2) 

where 9 e R n is the displacement vector, u € R m is the input force vector, M is the mass-inertia matrix, 
D is the viscous damping and Coulomb friction, C corresponds to the centrifugal and Coriolis forces, g is 
the gravity force, and k represents the spring coupling force. Note that in model (3.1), it is assumed that 
no external force is exerted on the manipulator, and that joint and link friction is position independent. 
We will consider manipulators with all its joints exhibiting flexibility and with each link being actuated, 

i.e. 9 = [ 0( T 0 m T ] where 9 ( , 9 m € R m are respectively the link and motor displacement vectors, and 
7 i = (2 • m). These assumptions are not essential but will allow to obtain a more concise presentation. 


We define the output of interest as 


y = m 


Usually y is a function uniquely of the link state. 


(3.3) 


3.1 Properties of the system 


We now state some properties of the system that will be useful in this paper. 

, iT ' 


C{9,9)9 = { M{9,9) - ^ 


0 (. M(9)9 ) 


09 


9 


M is used to denote the derivative of M(0) along the solution, Lev 


, J,n 0M{9) ■ 


(3.4) 


While C(9, 9)9 is unique, C(9, 9) is not. However, there is a close relationship between C(9 , 9) and M{9): 
for any choice of C(9, 9) and for any 2 6 R 71 , 

z(jti(9,z)-C{9,z))z = 0 

Two frequently used representations for C will be considered. 


Representation of C using ChristofFel’s symbols : In this representation, 


c kj i 

i= 1 


- £5 


(=1 


0M k j OMki OMij 

09 \ + 09 } 09 k 


9, 


For this representation, and this representation only, {±M{9,z) - C{9,z)j is skew-symmetric [21]. 
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Representation of C using A/^-notation : First define a matrix M D that depends on two vector 
arguments: 


MdV,v)*±^v'J 


where e t is the i th unit vector in R n . Md and M are related as follows: 

Md {& , v)w = M(9, w)v 

Md also satisfies 

Mp(9, v)w - Mq(9, w)v 
C(9, 9) can be expressed succinctly as 

C(M) = M d {9,9)-\mI{9,9) 


(3.5) 


(3.6) 


(3.7) 


(3.8) 


The Coriolis and centrifugal coefficient matrix C will be represented by C to denote an arbitrary choice 
of representation unless noted otherwise, by Cc to denote the representation by the ChristofFel s symbols, 
and by Cd to denote the representation by the Mp-notation. 

Also, it is always possible to find a vector function f(0) such that r{9 ) can be factored as 

r{9) = r(9) + R9 (3.9) 


for any user defined constant matrix R € 


R nxn 
R = 


R will 

i£n 

R 21 


be represented as 

Rl2 
R 22 


where i?n, Ru, R2 \i R 22 € R m!<m . 
We will also represent r as 

where r t , r 2 € R mxl . Similarly, 


r(9) = 


ri(9) 

r 2 (9) 


m = 


fm 

f 2 {9) 


where ri,r 2 € R mXl . 


The friction term D can also be represented by the sum of a linear component Dq and of a nonlinear 
term D\ as follows 


D{9) = D 0 9 + D 1 {9) 


3.2 Structure of the model 

It is well recognized that the control of flexible joint robots is highly dependent upon the structure of the 
model, which depends on various factors including the kinematic arrangement of the links and the way 
motors are mounted [7, 14, 20, 27, 35]. The following standard modeling assumptions have been used in 
the literature [7, 20, 26, 27, 30] : 


• Linear spring assumption. 


• Motor inertia is symmetric about motor axis of rotation (M and gravity forces only depend on 9 e ). 

• Kinetic energy of each motor is due mainly to its own rotation, or motion of motor is a pure rotation 
with respect to an inertial frame (Neglect gyroscopic effects; M u = Mj 2 = 0). 


None of these assumptions will be used a priori. However, we present here the structure of the model 
that is obtained under some standard assumptions and for specific manipulator structures. 


3.2.1 General model 


For a general flexible joint manipulator, equation (3.1) can be expanded as [8, 20]: 


9 m ) Mu ( 9e,9 m ) 
M? 2 {9 tl 0 m ) M 22 (9 m ) 

C\\(9t, 9 m ,9(, 9 m ) C\ 2 {6i, 9 m , 9(, 9 m ) 
C 2 i{ 9(, 9 m , 9(, 9 m ) C 22 {9 ( , 9 m ,9(, 9 m ) 

D t (9t ) 

D m (9 m ) 


0t 


9 


m 


9t 

9 m 


+ 


+ 


+ 

ri{9e,9 m ) 


’ 0 ' 

r 2 {9 ( ,9 m ) 


I 


(3.10) 


ri(9 ( ,9 m ) 


ge(9e,9 m ) 

+ 

' Nk x {9 t ,9 m ) ' 

r 2 {0e,9m) _ 



-ki(9(,9 m ) 


(3.11) 

where 9 t ,9 m £ R m are the link and motor displacement vectors respectively with elements numbered 
from base to tip, link m being the last link; u 6 R m is the input force vector; M u is the mass-inertia 
matrix of the links including the mass of the motors mounted on the links as if they were rigidly attached 
to the links; M 22 is the motor inertia matrix; Mu represents the coupling or interaction matrix that gives 
the dynamic coupling between the motor and link accelerations; Mu is the counterpart that gives the 
interaction between the link and motor accelerations; D( and D m are respectively the torques due to link 
and motor viscous and Coulomb friction (the effect of friction in the transmission element is neglected); 
C n and C \2 represent the coefficients of the torque acting on the link shafts due to centrifugal and 
Coriolis forces; Cj 2 and C 22 represent the coefficients of the torque acting on the motor shafts due to 
centrifugal and Coriolis forces; g c and g m are the gravity forces acting respectively upon the link and 
motor shafts; k\ represents the spring coupling forces; N is the matrix of gear ratios; and 0, I 6 R mxm 
are respectively the zero and the identity matrices. 


3.2*2 M \2 nonsingular 

This condition may arise when the stator of motor i, i = is mounted on the link it drives 

(rotor elastically coupled to link i — 1), or on a link higher in the chain, i.e, on a link ji, ji > for 
certain kinematic configurations such as planar robots with the axis of rotation of the motors and links 
all coplanar. The system is then represented by the same equations as the general model, i.e. (3.10, 
3.11). 

Subcase : Symmetric motor inertia 

If the inertia of the motors is symmetric about their axis of rotation, then (3.10,3.11) become 


' M n (9() 

(&t) 

' 9t ' 

_L 

' Cu(9 t ,9(,9 n ) Cu(9 e Je)' 

' 9 e ' 

. M&Ot) 

A /22 

. 0™ . 

1 

cmJ< ) 0 

. . 


D({9() 

+ 

r\(0e,9 m ) 


’ 0 " 

D m {9 m ) 

r 2 (9 ( ,9 m ) _ 


I 


u (3.12) 
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(3.13) 




ge( 8 e) 


■ Nk!( 8 t,e m ) ' 

^• 2 ( 81 , 8 m ) 


0 

I 

-ki(8(,8 m ) 


3.2.3 M \2 strictly upper triangular 


The matrix Mu may be singular but non-zero when the energy of at least one motor is due to its own 
rotation. Also, a common configuration yielding this condition is when the stator of motor i is mounted 
on link i - 1 while its rotor is elastically attached to link i for i = 1, • ■ m (the stator of motor 1 is 
mounted in the inertial frame). In a more general case, the stator of motor i is mounted on link j t while 
its rotor is elastically attached to link i for ji < i and i — (This leads to Mu = 0 if all the 

motors are mounted in the inertial frame). It has been independently pointed out in [19] and [31] (the 
former is for the exact case) that for that case, Mu is strictly upper triangular. 

We now present the structure of the model with symmetric motors for Mu strictly upper triangular 
where M \2 is state dependent or constant. 


Subcase 1 : Symmetric motor inertia and strictly upper triangular 

In this case, the system dynamics are described by (3.12, 3.13) with the Coriolis and centrifugal matrix 
having the following structure: 


C(OtJtjm) 


' c*(0 e , Ot) + C&Wt, 9 m ) C&(8 e , 8 ( ) 
C&(8 t j { ) 0 


where Cjj is the Coriolis and centrifugal term for the rigid robot and the structure of the other terms is 
described below (see Appendix A for the complete set of equations). 


It was pointed out in [31] that M u has the following structure: 

Afw(fc) = 


0 mi i2 (^,i) ••• 

0 0 rn 2l 3(^,2) 


0 0 0 0 
where rn,j are scalar functions. This particular structure for M \ 2 yields that (Appendix A) 

• cfi is skew— symmetric with row m equal to zero and row i independent of any 0 ln j , j < 1 
i m - 1, 


• Cj 2 is strictly upper triangular, 

• ^21 is strictly lower triangular. 


Subcase 2 : Symmetric motor inertia, and A /12 constant and strictly upper triangular 

Matrix M 12 may be constant due to the configuration of the manipulator and due to the position (orien- 
tation in particular) of the motors on the links. This is the case when the axis of rotation of each motor 
is coplanar with the axis of rotation of the link that it drives, and that the axis of rotation of the links 
are mutually perpendicular (possible for up to three links, unless some of the motors are mounted in the 
inertial frame yielding weaker constraints and allowing for a larger number of links). 


In this case, the system dynamics are described by 


' M u (8 t ) 

Ml 2 

8( 

1 

’ CniOtJt) 0 ' 

" 8( ‘ 

4 - 

Dt{8 ( ) 

1 

EH 

M 22 

. . 

T 

0 0 

. *•» . 

1 

_ D m (8 m ) . 


9 


ri{9 ( ,9 m ) 


' 0 ' 

_ r 2 (9 ( ,9 m ) _ 


I 


r\{9t, 9 m ) 


ge(9e) 

+ 

r 2 {9(, 9 m ) 


0 


Nh(9 ( ,0 m ) 

-ki(0(,0 m ) 


(3-14) 


(3.15) 


where Cn is the Coriolis and centrifugal term for the rigid robot. 

3.2.4 Mu = 0 

There is no gyroscopic coupling when the energy of each motor is due to its own rotation, e.g. the motors 
are mounted in an inertial frame, or all the motor axis are perpendicular to the link axis [20]. 

In this case, the dynamics of the system are described by 

ft.) 1 T a. 1 

+ 

r a i 

u (3.16) 


Mn(9(,9 m ) 

0 

' 9 t ' 

+ 

Cu{Be, 9 m ,9 ( ) 

C\ 2 (9e,9 m ,9() 

' 9t ' 

0 

M 22 (9 m ) _ 

. . 

. C 2 i(9eJ m ,9e) 

C 22 (9 m ,9 m ) 

. O’* . 


Dt{9 t ) 

_L 

T\{9t,9 m ) 


’ 0 ' 


[ 

r 2 (9(,9 m ) 


I 


ri(9 t> 0 m ) 



+ 

’ Nk x {e t ,9 m ) ' 

_ r 2 (9 t ,9 m ) 


$m) 

-k\(9 ( ,9 m ) 


(3.17) 


Subcase : Symmetric motor inertia 

If the inertia of the motors is symmetric about their axis of rotation, (3.16,3.17) become 


! M n (9e) 0 1 

' i t ' 

+ 

’ Cn(0 e ,ie) 

0 " 

■ 0t ' 

+ 

' Dt(9 e ) 

1 

C* 

o 

. . 

0 

0 

. irn . 

_ D m (9 m ) . 


1 

i— ‘ 

3^ 

i 


' o ' 

_ r 2 (0e,9m) _ 


i 


ri(9(,0 m ) 


gt{9t) 

4- 

‘ Nki(9 t ,9 m ) ' 

_ r 2 (9 t ,9 m ) 


0 

i 

-kx (9 e ,9 m ) 


(3.18) 


(3.19) 


This model has the same structure as used by Spong [27] and many other researchers. 

3.3 Notation and useful bounds 

We define the position error and velocity error as 

A 9 = 9-9 d , A9 = 9-9 d 

and so on for higher derivatives. 

Also, QW denotes the i th derivative of 9 , and a function / € C k if it is continuous and differentiable k 
times. Furthermore, the i tfi row of a matrix or the i th element of a vector will be noted by the subscript 
“, t” (without the comma for a matrix or vector without subscript), and a particular element of a matrix 
will be denoted by its coordinates in parenthesis as a subscript. 

The following notation for various bounds will be used later in this paper: 
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a M = inf (Train (A/(0)} 

9 

Oc v = Ctnin {A> + BIi v B T } 


lid = sup 

t>0 


m 


iDd = sup 53 

i=l 3=1 

7e = SUp || A0(t)|| 

<>0 

1M = sup ||A/(0)|| 

9 


1R = sup ||Vtff( (9)|| 


d 2 M(0) 


dOidBj 


a p = cr mi „ {.R + BK p B t } 
7<i = sup \\9 d (t)\\ 


«>o 


dM{9) 

1D = s 7t Sir 

1 Do = ||A>|| 


7ed = sup \\Am\\ 


7 P = 


R + bk„b t 


Iv = A) + BK V B 1 


where K P ,K V € R nxn are controller gains. 

The following results will also be used in the paper. 

Due to the positive definitiveness of the mass matrix M in (3.1), and of Mu and M 22 , w e can always 
solve for 9 t and 9 m from (3.10). In (3.10), dropping the dependence on the state in the equation, define 


Pi 
P 2 


Cn Cl 2 

C 21 C 22 


9 e 

9 m 


+ 


D e 

D m 


+ 


7*1 

T 2 


Then, we have, for the general case, 


9m = 


Also, the following relations hold: 


• M l2 M 22 M? 2 } 1 \m 12 M 22 (p 2 - u) - Pi] 

(3.20) 

M \2 M ll M 12\ 1 - Pi + u] 

(3.21) 

C D {9,9)9 d - ^M D (9,9)9 d + ^ M D (9,9 d )9 

(3.22) 

±M D (9j)0 d - - 2 Ml{9,9)9 d + - 2 M D {9,9 d )9 

(3.23) 

\c D (9,9)9 d +\c D {9,9 d )9 

(3.24) 


Proof : Equation (3.23): direct substitution of (3.8) in (3.22). 

Equation (3.24): add and subtract ^Mp(9,9)9 d to (3.22), and use (3.7) and (3.8). 


J = A 9 t 


C D (9j)A9+±M D (9j)9 d - ^M D {9,9 d )9 - ~M(9,9)A9 


= 0 


Proof : By direct substitution, 


(3.25) 


J = A9 T 


M d (9,9)A9- \mI{ 9,9)A9 + \M D {9,9)9 d - ]rM D {9j d )9 - ^M D (9, A9)9 
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Add and subtract \ Md(9> 0)9 to this equation and use the linearity property of M D in its second argument 
to obtain 


V, 

II 

> 

H 

M d (9,9)A9-±M%(9,0)A9- 

\m d {6,9) A9 

= A 9 t 

±M d (9,0)A9-±mI(9,9)A9 



- 0 


due to the skew-symmetry of the term in brackets. 


\\M(e d )-M(e)\\< lD \\A9\\ (3.26) 

Proof : 7 d corresponds to the supremum of the norm of the gradient of A/, leading directly to this 
identity. ■ 


J - 

On — 


C D {9,9)A6 + ^M D {9,9)9 d - ^M D {^9 d )9- M (9,9) A9 


, 3 

* V D 


A9 2 + ^ 7 D 9 d 


A* 


(3.27) 


Proof : Add and subtract \Md{9,9)9 (inside the norm operation) and use (3.6) to write 


J n = -||m d (M)A0-M£(M)A0- M d {9,A9)9\ 


< \\\m d (9,9) 


A 9 


1 

+ 2 


Ml{9,0 ) | |M| + ^|m d (0,A0)|| \0 


and use (3.5) to write 


3 

Jn < -jlD 

9 

A 9 


3 

= V D 

A 9 + 9 d 

| A<?|| 

3 

< JW 

A 9 

2 

+ ; 

pD |pd|| ||a*| 


which concludes the proof. 




2 + j™ m ii^« 


(3.28) 


Proof : Use (3.23) to write 
| C A (9,9,9 d ) 


< £1 M D (9,9)9 d +i Ml(9,9)9 d 


1 

2 

3 


+ 2 


M D (9,9 d )9\ 


< ~ 2 1D 


9 d 


which leads to the conclusion by using 


< 


A 9. 


l -M D {0,9)9 d - \hl D {9,9 d )9 


< ID 


NH 


(3.29) 
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Proof : Add and subtract ±M D (O,9 d )0 d (inside the norm operation) to write 


±M D (9,9)0 d -±M D (9,9 d )6 


^M D (9,A9)9 d - ±M D (0,9 d )A9 


< ID 1^1 


A9 


which ends the proof. 


Jm = | C D (9 d ,9 d )9 d - C A (0jj d ) I < \iDd m* ||A0|| + | ID 1^1 
Proof : Use (3.22) to write 

J 771 — 


A0 


(3.30) 


C D (9 d ,9 d )9 d - C D (9,9)9 d + ±M D (9,9)0 d - ±M D (0j d )9 


Add and subtract C D (0,0 d )9 d and \Mj ) {9,9 d )9 d (inside the norm operation) to obtain 

Jm = ~ C D (9,9d)9 d - C D (0, MWd + ^M D (9,A9)9 d - ^M D (9,9 d )A0 

< | C D (9 d ,0 d )9 d - C D (9,0 d )0 d || + -C d { 6, A9)9 d + ±M D (9,A0)9 d - ±M D (9,9 d )A9 

< ^Mo(9 d ,9 d )9 d — Mp(9,9 d )9 d + - — Mp(9, #d)0d| + 

\\-Im d { 9, A9)9 d + \Ml{9, A9)9 d - lM D (9,9 d )A9 


< 2 V* 


9d 2 ||A0|| + ^7 D 


Od 


Ad 


Where we have used the definition of M& (3.5), and in particular, the supremum of the bound of the 
gradient of Mq with respect to 6 to obtain the bound in 7 ■ 

For C represented using the Christoffel’s symbols, the relations listed below hold. 

There exists a unique and finite real constant 7 C that satisfies, for any 9 and any finite w , 

\\Cc(0,w)\\ <7cHI ( 3 - 31 ) 

Proof : The evaluation of this bound, and in particular of a tight bound 7 C I s n °t straightforward and 
is not provided here. ■ 

There exists some constant 7 cd so that 


\\C c (O d j) - C c (9,9)\\ < 7cd\\M\\\\8 


(3.32) 


Proof : This bound is a function of the supremum of the norm of the gradient of Cc but is difficult to 
find analytically so that no proof is provided. ■ 


9 d 


A0 


Also, there exists some constant jc -2 so that 

\\Cc(9,6)A0 - M(M)A0|| < 7 c 2 ||A<?|| 2 4- 7 c 2 
Proof : We may write 

\Cc(9,9)A9 - A/(M)A0|| < ||Cc(M)A0|| + \\M{9,0)A9 

< 7cH||tf|+7DH \\9 


(3.33) 


< (7C + 


Id) ( 


A 9 


+ 


A 9 
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where we have used (3.4) and (3.31). We obtain the desired conclusion by choosing 7 c 2 = Jc + lD, which 
gives a loose evaluation of the bound. ■ 


CcWdJd) - CcWM < led 




+ 7c 


A9 


Proof : We may write 

|Cc(0d,0<i) ~ Cc{9,8) 


< 


lCc(ed,0d)-Cc(Wd)-c c (9 t Ai)l 
1 C c {6dM ~ C c {9,9 d ) | + ||Cc(0, Atf)|| 


< 7 Cd 


||A0|| 9 d + 7c A 8 


where (3.32) has been used in the last step. 
Finally, 


(3.34) 


||r(0) - r(9 d ) || < 7/?||A(?|| (3.35) 

Proof : 7/1 corresponds to the supremum of the norm of the gradient of f, leading directly to this 
identity. ■ 


4 Controller design approach 

The synthesis of the material presented in Section 2 leads to a control design approach based on passivity 
for a large class of systems. Assuming that we can form an error system and render the error system 
passive by static feedback, we can then I 2 -stabilize the error system by using any finite gain strictly 
passive controller. Then, if furthermore the error system with static feedback is at least weakly zero-state 
detectable, then internal asymptotic stability is also guaranteed. 

Flexible joint manipulators are members of the class of systems to which such an approach can be 
applied since such systems are feedback equivalent to passive systems for a proper choice of outputs, and 
in particular for any arm configuration if the motor velocities are used as outputs as shown in Appendix 
B. 


Problem statement Consider the dynamical equation of the system (3. 1,3.2) rewritten here for com- 
pleteness: 

M{9)9 + C(9, 9)9 + D{6) + r(6) = Bu 

r{8) = g(9) + k(9) 

r ]T 

B — 0 mxm f m X m 

Find u so that the output of interest y = h(8 e ) — y d asymptotically. 

We now present a design procedure that involves essentially two steps defining the basic structure of 
the controller, i.e. (i) define a model-based feedforward in order to form an error system; (ii) add a 
model-independent stabilizing feedback to the feedforward. 

1. Feedforward Design: Decompose the control input as 

U = U 0 + Uff 
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y 


U2 




Error 

System 


Vv 


Vp 



Figure 1: Structure of the proposed controller 

where is the feedforward input and u 0 the stabilizing input. The feedforward is chosen such that 
the output of interest y tracks the desired trajectory under matched initial conditions. The choice 
of feedforward must also allow to form an error system that is passive or can be rendered passive 
between a particular input/output pair (u\, y v ) via static feedback from some output y p (Fig. 1). 
The results presented in [5] can be used to guide the choice of the output y v (Appendix B). 

2. Feedback Stabilization: Find a static feedback (inner loop C p ) to obtain passivity and zero-state 
detectability for the pair (iti, y v ). Then choose a finite gain strictly passive feedback (outer loop C v ) 
between the passive input/output pair. By the Passivity Theorem [9], this guarantees Z 2 ~stability 
of the system from U 2 to y v . Use an energy based Lyapunov analysis to show that output y v —+ 0 
asymptotically. From zero— state detectability, the zero error state is also asymptotically stable, and 
the output of interest y ^ yd asymptotically. 

NOTE : Three outputs are defined in the design procedure. In the case of flexible joint robots, the 
output of interest y is generally defined in terms of 9 while 9 m (or A0 m ) has been used as the passive 
output j /„, and 9 m (or A6 m ) has been used as y p in [16, 24] to render the system zero-state detectable 
from u\ to y v . 

NOTE : Weak zero-state detectability is also sufficient to guarantee asymptotic stability given y v — 0 
asymptotically. 

This approach hats interesting features, namely : 

• C v can be any BIBO strictly passive feedback and can be tuned for performance enhancement. 
Note that BIBO stability is implied by strict passivity for finite dimensional linear time invariant 
systems. 

• Only y p and y v are needed for stabilization, i.e. only motor position and velocity for flexible joint 
robots. 

• Error in the feedforward does not cause instability, i.e. small errors in the feedforward only lead to 
a weaker form of stability (see Section 8). 

• Applicable to both position set point stabilization [16] and tracking control. 

The design approach offers a certain degree of flexibility in the sense that certain choices must be made. 
In particular, different forms of feedforward can be used yielding different characteristics regarding their 
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solution (solubility, required model information, required signal measurements, complexity) (Section 5), 
and the type of stability and tracking accuracy that are obtained (Section 8). Another choice that has to 
be made is which controller in the class of strictly passive controllers should be used in order to obtain 
the desired performance. Among this class of controllers, we will use the classical PD (Proportional- 
Derivative) controller to carry out the design in Section 6. 

In the following section, we present various possible forms of feedforward for the trajectory tracking 
problem and address the issue of solving the feedforward. We then carry out the controller design in Sec- 
tion 6 for particular choices of feedforward under the assumption that the condition of (weak) zero-state 
detectability is met, assumption that is verified in Section 7. The design approach guarantees asymptotic 
stability only if all the design conditions are met, which is strongly dependent on the feedforward signal 
that is used. A Lyapunov stability analysis is carried out in Section 8 to analyze the stability of different 
forms of feedforward, in particular approximations of the feedforward based on the inverse plant. 

5 Feedforward: selection and solution 

In this section, we present a series of possible forms of feedforward for the problem of trajectory tracking 
and address the issue of solving for the feedforward. In particular, conditions for solubility including 
required measurement and modeling information are stated. 

5.1 Selection of feedforward 

Assume that, given y d = h(9( d ), we can solve for 9 d . There are many possible feedforward compensation 
based on the inverse dynamics of the system (FFl below) and its approximations that can be used, e.g. 

FFl. Bug — M(9 d )9 d + C(0d,6d)Qd + D(9 d ) + r(9 d ) 

FF2. Bug = M{9 d )9 d + C(9 d ,9 d )9 d + D(9 d ) + f(9) + R9 d 
FF3. Bug = M(9)9 d + C{9 , 9)9 d + D{9 d ) + r(9 d ) 

FF4. Bug = M(9)9 d + C{9 , 9)9 d + D(9 d ) + f(9) + R9 d 

FF5. Bug = M(9)9 d + C D (9,9)9 d - 1 2 M D (9j)9 d + \M D {9,9 d )9 + D(9 d ) + r(9 d ) 

FF6. Bug = M(9)9 d + C D {9,9)9 d - \M D {9,9)9 d + \M D (9,9 d )9 + D(9 d ) + f(9) + R9 d 

FF7. Bug = r{9 d ) 

FF8. Bug = r(9) + R9 d 

Note that feedforward FF7 is the same as used for the set point control, e.g. [16, 31]. 

There are multiple considerations in the choice of feedforward, namely, the measurements and model 
information required to solve for the feedforward and for its implementation, the complexity of the 
solution, and the performance it allows to obtain regarding stability and tracking. We now analyze the 
solution of the different forms of feedforward and will analyze their performance in Section 8. 

The solution of the feedforward is a stable inversion problem. We will use a procedure for the solution 
that involves essentially three steps defined as follows 

1. From the last m equations of the feedforward equation (FF1-FF8), define what signals are required 
to compute the feedforward. 
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2. Given the desired output ( 6 td and its higher derivatives, i.e. link reference trajectory provided by 
the user) and the signals available by measurement, determine the desired internal state (9 md and 
its higher derivatives as required by the feedforward, i.e. desired motor reference trajectory) by 
using the first m equations of the feedforward, and possibly additional information such as the 
original system equation. The result that we are seeking at this step is a causal and bounded 
desired internal state yielding a bounded feedforward signal provided that the desired output state 
is also bounded, i.e. it should be a stable and causal solution. 

3. Evaluate the feedforward. 

Proposition 5.1 Consider the properties of the system (Section 3.1) and assume that D(x) and r(y) 
are bounded functions of their argument. Then, if the desired trajectory (6 d and its higher derivatives) is 
bounded, tiff is bounded in 


• FFl and FF7, 

• FF2 and FF8 if the following assumption is satisfied 

Assumption 5.1 ||A0|| is uniformly bounded in time by a finite constant 7e- 

• FF3 and FF5 if the following assumption is satisfied 


Assumption 5.2 


A0 


is uniformly bounded in time by a finite constant ') ed . 


FF4 and FF6 if both Assumption 5.1 and 5.2 are satisfied. 


Proof : Consider FF4 with C represented using the Mp-notation. Premultiply the equation of FF4 by 
B t and use (3.9) to obtain 

ug = B t ^M(9)9 d + Cd{ 9, @)@d + D(@d) + r (@) ~ -RA#] 


VI 

2 

i 


)\M(9)\\ \e d \\ + 

Cd{9, 0)| 1^1 + |T>(^)|| + ||r(0)|| + \\R\\ ||A0||] 

U < 

bt \ 

1M 

M + b D 

9 9 d +|j3(^ + ||r(Afl + ^)|| + P||||A«||] 

- s i 

\* t 

7 M 

M + \ id 

9 d 2 + \ 1D ||a/?|| 1^1 + ||z?(^)|| + ||r(A0 + 9 d ) II + PH || A0|| 


which leads to the conclusion of the proposition since ||5 r || and ||£|| are also bounded. The same proce- 
dure is used for the other forms of feedforward and for the C matrix represented using the Christoffel’s 
symbols. ■ 

The following assumptions will be particularly useful for the solution of the feedforward: 

Assumption 5.3 rj is continuous and differentiable, and the gradient of r i(9(, 9 m ) with respect to 9 m , 

Ve m ri{0 e<t ,0 m ), is ITlVCVtlblc 2 Ti SOTT16 OJ)€Tl SCt XTX 0 . 

Assumption 5.4 D{9) is continuously differentiable as many times as this function needs to be differ- 
entiated to solve for the feedforward. 

We will also assume that the reference output trajectory is bounded. 
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5.2 Solution of FFl 


Expand FFl to obtain, for the general model, 

0 = Mn(9g d ,9 md )9e d + M\ 2 (9( d , 

^ 77l cf)^ m d CnWe d , ^771^7 ^77l d )^ d 

0\2 {@t d 7 ^m d )^Tn d + De(Qe d ) + ri(9( d ,6 md ) (5.1) 

u 9 ~ Mi 2 (6i d ,Om d )0e d + M 22(6 C 2 I (O( d ,9 md ,O( d ,0 md )^t d + 

C?2{Qm d i Qm d )Qm d + D m (9 md ) + ^2 (9( d ,9 md ) (5-2) 

To obtain a closed loop form for the feedforward control input ug from (5.2) for (9( d ,9g d ,9g d ) given , we 
must first define (9 md ,9 md , 9 md ). 

The problem of solving for (9 md ,9 md , 9 md ) resumes to solving (5.1) for these variables given the input 9g d 
and 9 td , 9 g d . This problem may have multiple solutions as in the case where M 12 is nonsingular. In that 
particular case, the user is free of choosing the initial values for 9 md ,9 rnd . An important characteristic 
that is desired for the solution is its stability in the sense that the desired motor state should stabilize 
in order to obtain internal stability not only of the error state, but also of the actual state. This allows, 
among others, to reduce the stress on the equipment. 

Zero-state detectability or weakly zero-state detectability properties of (5.1), with y = (9e d ,9e d ,9e d ), 
and x = (9 md ,9 md ,9 m<t ) in Definitions 2.8 and 2.9, allows to characterize partially the solution for 
(9 md ,9 md ,9 md ) either locally or globally. 

Fact 5.1 Zero-state detectability of (5.1) constitutes a necessary condition for uniqueness of the solution 
for (9 md ,9 md ,9 md ). 

Fact 5.2 Weak zero-state detectability of (5.1) constitutes a necessary condition for the solutions for 
(0Tn d ,0m d ,Om d ) be asymptotically stable. 

A more global condition is obtained if we require that 9 td constant implies 9 md = 9 C (zero-state de- 
tectability of any shifted state), or implies (9 md ,9 md Jm d ) — (^-,0,0) (weak zero-state detectability of 
any shifted state), where 9 C € R m is constant and uniquely defined for each 9g d . 

Example 5.1 One case for which (5.1) is zero-state detectable and FFl has a unique solution is the 
following. First, assume that the inertia of the motors is symmetric about their axis of rotation, and that 
M\2 is strictly upper triangular (Section 3.2.3). Also assume that the i th element of r l (9g,9 m ) depends 
only on (0r,j,# m ,,). Under these assumptions, expand FFl to obtain 

0 = Mu(9g d )9( d + Mi2(9g d )9 md + Cix(9( d ,9( d )9( d + Cfi(9( d ,9 md )9e d + C li (9g d ,9( d )9 md + 

D t (9 (d ) + ri (9^9 md ) (5.3) 

ug = + M 22 L d + C 2 \(9 (d j (d )9 (d + D m (9 md ) + r 2 (9 (d ,9 md ) (5.4) 

Also suppose that Assumption 5.3 holds. This implies that, by the Implicit Function Theorem [3], there 
exists a locally unique solution 9 md to (5.3) for any given 9 md , 9 md , and 9( d and its higher derivatives. 
However, 9 md and 9 md are not known a priori. 

In order to solve for 9 md and its derivatives, we take advantage of the fact that M\ 2 and C( 2 ar e strictly 
upper triangular and that row i of Cf\ does not depend on any 9 m< j for j < i and i = 1, • • ■ ,m. This 
allows to solve iteratively for the elements of 9 md from its m th element to the first. 

Given 9g d and its higher derivatives, use the last row of (5.3) to solve algebraically for 9 md m . Then 
suppose that Assumption 5.4 holds and evaluate 9 md ^ m and 9 md>m by taking the time derivative of 9 md<m . 
Now, given 9 md<m and 9 md<m , use the second last row of (5.3) to solve algebraically for 9 mdiTn - 1, and 
continue the process down to 9 md . i- Note that the desired trajectory has to be very smooth since the 
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solution of the last term of the iteration, i.e. 9 mdi i, requires 9'f^ 1 \ 1 = l> m i an d that the characteristic 
of the equivalent spring of joint i be differentiable 2 i times in both its arguments for * = 1, m. 

Noting that all the coefficients of the equations use to solve for the feedforward are bounded, we conclude 
that the desired internal state is bounded given a bounded desired output trajectory. 

We then obtain the feedforward input by substituting the variables in (5.4). 

Hence, the solution of ug for this case requires invertibility (at least local) of r x and of V^rj along 
with knowledge of the full model, a very smooth input trajectory and differentiability to a high order of 
rj. However, no measurements are required. D 

5.3 Solution of FF2 


Expand FF2 to obtain, for the general model, 

0 = Mn(O( d ,0 md )de d + Mi2(0e d , Cu(&( d , 0m d , ®i d , Qm d )6( d + 

Cu{6t d ,0m d ,9t d ,bm d )8m d + D e (9 t d ) 4 - fi(9 e ,9 m ) 4 - R\\9t d + Rn0m d ( 5 . 5 ) 

Ug = M x2 {9(. d ,9 md )6( d + M22(9,n d )9 m d + c 2l (6 (d , 

®m d 1 5 &rn<i W( d + 

C22(0m d ,0m d )dm d + D m (9 m<{ ) + f 2 {$( , 9 m ) + R 2 A d + # 22 ^ ( 5 - 6 ) 

To obtain a closed loop form for the feedforward control input ug from ( 5 . 6 ) for ( 9t d ,9( d ,0( d ) given, we 
must first define ( 9 md ,9 md , 9 md ). 

The problem of solving for (9 md ,9 md Jm d ) is very similar to the one encountered with FFl except that 
(5.5) depends on the actual state ( 9 t ,9 m ). Hence, the feedforward and the control input are intertwined. 
This renders the task of characterizing the solutions more difficult: we must know the controller in order 
to ascertain stability of the feedforward input. However, we may assume that the closed loop system is 
stable and that the error signals are bounded in order to pursue the analysis. 


Example 5.2 Consider Example 5.1 with the additional assumption that R X2 is chosen nonsingular and 
upper triangular (or diagonal). Expanding FF2, we obtain 

0 = Mn(9e d )9( d + M l2 (9 (d )&m d + C\ X (9e d , 8( d )9t d 4- C \i(9( d ,9 md )9( d 4- C X 2(9t d , 9t d )9 md + 

D((9( d ) + f x (9(, 9 m ) + R\\9t d + R\ 2 9 md ( 5 - 7 ) 

ug = M^(9 (d )9 (d + M 2 29m d + C^(9 (d ,9 fd )9 (d + D m (6 md ) + r 2 (0t,0 m ) + R 2l 9 (d + £ 22 ^ (5.8) 

In order to solve for 9 md and its derivatives, we take advantage of the structure of M x 2 , Cfj, C{ 2 and R\2 
to solve iteratively for the elements of 8 md from its m th element to the first. 


Given 9i d and its higher derivatives, and assuming that 9c and 9 m are available for measurement, use the 
last row of (5.7) to solve algebraically for the m th element of 9 md : 




= -R 




-1 


Mu, m {9 ed )9e d + Ci lrn {9f d ,9( d )9( d + 

D c ,m (9e d ) + r i (9 e ,m « 8 m rn ) 4- 

,(m,T7i 


(5.9) 


We solve for 9 md>m by taking the first time derivative of (5.9) under the assumption that 9( and 9 m are 
available for measurement and that Assumption 5.4 holds. Now, taking the second time derivative of 
(5.9) in order to find 9 md<m , we obtain, for X properly defined: 




-R 


12 


dt 2 


Mu t m{9t d )9( d 4- C xltm {9( d ,9( d )9( d + 
D t (Q ( d ) + f i (9f ,771 1 ,m 


-R 




-1 


, m r l ,m( » ^m,m )$m,m 


10 



Since $e and 9 m are usually not available for measurement, we want to remove the dependence on these 
variables. For this, we use the dynamical equations of the system (3.20, 3.21). However, due to the 
gyroscopic couplings, 0 m ,m may depend directly on all the inputs, i.e. in general we must know all the 
feedforward inputs in order to solve for this signal. We conclude that, in general, this approach does not 
lead to a practical closed loop form for the solution in this case. □ 


NOTE : Under the additional assumption that M x2 is constant in the previous example, the same 
problems are encountered in the solution of the feedforward. 

Example 5.3 Continue the previous example (Example 5.2) with the assumption that there is no gyro- 
scopic coupling, i.e, M 12 = 0 (Section 3.2.4). Expanding FF2, we obtain 

0 = Mn{9 ti )6t d + Cu(9t d ,9t d )dt d + D t (9t d ) + r l (0 e ,0 m ) + RnOt d + Ri20m d (5.10) 
Uff = M 22 9m d + Dm0m d ) + ?2 (9(,9 m ) + R21@l d + R'2’2^m d (5-H) 

Given 9 ld and its higher derivatives, that R X2 is nonsingular but otherwise arbitrary, and assuming that 
0t and 9 m are available for measurement, we have, from (5.10), 

9 md = — fZi2 _1 (9e d )9e d + Cn(0( d , 9( d )9( d + De(0e d ) 4- ci(9e,9 m ) + -Rn^ d J (5-12) 

and 9 md is bounded if Assumption 5.1 is satisfied. 

We solve for 9 md by taking the first time derivative of (5.12) under the assumption that 9 t and 9 m are 
available for measurement and that Assumption 5.4 holds. Now, taking the second time derivative of 
(5.12) in order to find 9 md , we obtain, for X properly defined: 


9 md = —R\2 1 ^Mn(9e d )9( d C\\(6e d ,9( d )9( d + De(9t d ) + fi(9(,9 m ) + Ru9( c 


= X (9( d , 8f d , 9( d , 9^J , 9^J, 9(, 9(, 9 m , 

— Rl2 1 l(9( , 9 m )9( ^ Q-m )^m] 


(5.13) 


We now use the dynamical equation of the system to write 9( and 9 m as a function of know signals. From 
(3.20, 3.21), 

9( = Mu(9()~ l JCn(#r, 9()9( + Dt{9() + ri(9(, 0 m )J (5-14) 

L = -Mn l [D m (9 m ) + r 2 (9 e ,9 m )\+ M^u (5.15) 

Substitute (5.14,5.15) in (5.13) to obtain, for X 2 properly defined, 

9 md = X 2 (9 t J t J (d ,9™,9Wj t ,9 t ,9 m j m ^ (5.16) 

which is bounded if Assumptions 5.1 and 5.2 are satisfied and if A9 remains bounded. 


Use (5.11) and (5.16) to write 


ug = 


Dm(9m d ) + r 2 (9t,9 m ) + R 2 \9t d + #220«i d j + 

M 2 2 {x 2 (9( d ,9e d Je d j[f,9^Je,de,9 m ,9m) - Ru~ l Ve m r x (9 ( ,9 m )M£ [(ti -ug)+ u^]} 


= M 2 2 JF + R\ 2 1 9 m ) {^22 4" r 2 (9( , 9 m ) + R 2 \9( d + f?22$m d J 4* 

[x 2 (#( d , 9( d , 6 (d ,9^, d[ 4 d \ 9 e , 9f ,e m Jm) - Ri2~ i ^e m ri{9t,9 m )M 2 2 (u - ug )] } 


where the term (u — ug) represents 
tion that [/ + R\ 2 ~ 1 ^ e m r\{9t, 9 m ) 
choice of R\ 2 - 


the contribution of the stabilizing controller, and under the assump- 
is invertible for all (■ 9 e ,9 m ), which is always possible by a proper 
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Hence, the solution of ug for this case requires invertibility of R\2 and of 1 1 + along 

with knowledge of the full model, measurement of the full state, differentiability of r x twice in both its 
arguments, and knowledge of the stabilizing controller signal. This last requirement also means that the 
feedforward and the feedback are intertwined. O 

5.4 Solution of FF3 

Expand FF3 to obtain, for the general model, 

0 = Mn(9(, 9 m )9( d + 9 m )9 md + Cii (9e, 9 m , 9f , 9 m )9i d + C X 2(9(, 9 m , 9(, 9 m )9 md + 

Dt(9e d ) + » ) (5 ' 17) 

Ug — M^2^ii^m)9(_ d + M22{^m)9-m d T C2l(9(, 9 m , 9(, 9 m )9( d + C22(9mi9 m )9 m<i + 

D m (6 md ) + r 2 (0t d ,6m d ) ( 5 - 18 ) 

To obtain a closed loop form for the feedforward control input ug from (5.18) for (9/ d , 9 fd , 9 id ) given , we 
must first define (9 md ,9 m<t , 9 md ). 

The problem of solving for {9 md ,9 md , 9 m< ) is very similar to the one encountered with FFl except that 

(5.17) depends on the actual state ( 6e,9 t ,0 m ,9 m ). Hence, the feedforward and the control input are 

intertwined. This renders the task of characterizing the solutions more difficult as noted in the discussion 
on the solution of FF2 (Section 5.3). 

If we try to find the closed loop solution under the same assumptions as in Example 5.2, in particular 

Mi 2 strictly upper triangular, we encounter the same problems as with FF2. We will thus consider the 

system in Example 5.3 to demonstrate the solution of this feedforward. 

Example 5.4 Assume that the inertia of the motors is symmetric about their axis of rotation, and that 
Mu - 0 (Section 3.2.4). Also assume that the i th element of r l (9 t ,9 m ) depends only on {9 (ti ,9 m>l ). 
Under these assumptions, expand FF3 to obtain 

0 = Mu(9e)9c d + Cn(9(,9e)9e d + D((9g d ) + ri(9( d ,9 md ) (5.19) 

Ug = M229m d + Dm{^m d ) + ^(^i ^m d ) (5.20) 

Also suppose that Assumption 5.3 holds. This implies that, by the Implicit Function Theorem [3], there 
exists a locally unique solution 9 m<t to (5.19) for any given 9 ( , 9(, 9( d and 9t d . 

To solve for 9 md and 9 md , assume that r x is differentiable twice in both its arguments and that Assumption 
5.4 holds. Take the first time derivative of (5.19) to obtain: 

0 = Mn(9(, 9()9( d + Mu(9(, 9t)9^ d + Cn(9c, 9 e, 9()9e d + Cn(^, 9 e , 9e)9( d + 

Di{9( d ,9 ( d ) + V ee d r i(9e d ,9 md )9e d + V 9 md ri(9e d ,9 md )6 md (5.21) 

We then solve for 9i by using the system equations in order to remove dependence of the feedforward on 
this variable (see (3.20)): 

9t = — Mu(9()~ l ^Cu{9(,9()9( + D({9() + ri(9(,9 m )^ (5.22) 

By substituting (5.22) into (5.21), we may write 

0 = + (5.23) 

such that we may solve for 9 m<t by Assumptions 5.3 and 5.4 provided that 9 md has been previously 
evaluated and that 9 ( , 9 t and 9 m are available by measurement. 
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We proceed similarly to evaluate 9 md by taking the first time derivative of (5.23), removing the dependence 
on §t by use of (5.22), and by assuming that 9 md has been previously evaluated and that 9 m is also available 
by measurement. We note that the fourth time derivative of 9( d is required. 

The internal state remains bounded if Assumptions 5.1 and 5.2 are satisfied. 

We then obtain the feedforward input by substituting the variables into (5.20). 

Hence, solution of ug requires invertibility (at least local) of r lt that rq is twice differentiable in both its 
arguments, along with knowledge of the full model and full state measurement. □ 


5.5 Solution of FF4 


Expand FF4 to obtain, for the general model, 

0 = Mu(0(,9 m )9( d + Mu(9(, 9 m )9 md 4- Cn(9(,9 m ,9e,9 m )9( d + Ci2(9(, 9 m , 9(, 9 m )9 md + 

Df(9f d ) + fi(9t,9 m ) + R\i9t d + R\ 2 9 md (5.24) 

Ug — M^ 2 (9(,9 m )9( d + M 22 (9 m )9 md + C 2 \{9(, 9 m , 9(, 9 m )9( d + C 22 (9 m , ^m)^m d + 

Dm(9m d ) + r 2 (9e,9 m ) + R 2 \9l d + R 22 9 m<i (5.25) 

To obtain a closed loop form for the feedforward control input ug from (5.25) for (9e d , 9( d ,9t d ) given, we 
must first define (9 md ,9 md , #m d )- 

The problem of solving for (9 md , 9 md , 6 md ) is very similar to the one encountered with FF2 except that 
(5.5) depends on the actual state ( 9(,9(,9 m ,9 m ). 

Example 5.5 Consider the system used in Example 5.3. Expand FF4 to obtain 

0 = Mu(9()9e d + Cn(9(,d()9e d + De(9( d ) + ri(9(,9 m ) + Ru6( d + Ri29 md (5.26) 

ug = M 22 ^m d + D m (9 md ) + f 2 (9e,9 m ) + R 2 i9( d + R 22 ^m d (5-27) 


Given and its higher derivatives, that R\ 2 is nonsingular but otherwise arbitrary, and assuming that 
9(, 9f and 9 m are available for measurement, we have, from (5.26), 


9 md = -R\ 2 1 Mu(9()$t d + Cu(9 t ,9()0e d + D((9( d ) + ri(9 e ,9 m ) + Ru$t d 


(5.28) 


Suppose that Assumption 5.4 is satisfied. We solve for 9 md by taking the first time derivative of (5.28) 
under the assumption that 9 m is available for measurement, and by removing the dependence of this 
equation on 9( by using the system equations as done in Example 5.4. Now, taking the second time 

»v / 

derivative of (5.28) in order to find 0 m<j , and substituting 9(, 9\ by functions of measurable state only, 
we may write, for X properly defined: 

9 md = ~ R\2~^ ^2 \Mu{9()9t d + Cn(9(,9()9e d + De(9( d ) + f\{9t,B m ) + Ru9 ( d J 

= X (0( d Je d J l ^,9[ 4 d \9 e ,9 e ,9 m ,9 m ) 

-R12' 1 [VeM 0 e> 0 m)6t+ V 9m f x {6 t ,9 m )9 m \ 

0m d is of the same form as in (5.13) so that we pursue the solution as in Example 5.3, and the 
same conditions for solubility are obtained as for FF2. Furthermore, the signals remain bounded if 
Assumptions 5.1 and 5.2 are satisfied. O 


5.6 Solution of FF5, FF6 

The solution of FF5 and FF6 are respectively very similar to those of FF3 and FF4 such that the 
reader is referred to Sections 5.4 and 5.5 for information about their solution. 
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5.7 Solution of FF7 


Expand FF7 to obtain 

0 = ri(6 ld ,e md ) (5.29) 

Ug — r 2 (0 (d ,9 md ) (5.30) 

To compute the feedforward control input ug from (5.30) for a given 9( d , 9 md must first be defined. 

Suppose that Assumption 5.3 holds. Then by the Implicit Function Theorem [3], there exists a locally 
unique solution 9 m<1 to (5.29). The solution can then be substituted in (5.30) to obtain ug. 

Hence, solution of ug requires invertibility (at least local) of Vg m ri(9(,9 m ) along with knowledge of r, 
i.e. gravity load and spring characteristics. No other restrictions are imposed on the system and no 
measurements are required. 

If higher order derivatives of 9 md are required for the controller, we may proceed as follows. In order to 
obtain the i th derivative of 9 m<t further assume that r x is differentiable i times in both its arguments, and 
that all higher derivatives of 9 (d up to the i th are available. Take the first time derivative of (5.29) to get 

0 = V s t /i{9 td , ^ m d )9( d + ^B md T\{9t d , 9 m d)Qrn<i (5.31) 

L d = - 

given that 9 md has been previously evaluated. 

Taking the time derivative of (5.31), and given that 9 md and 9 rnd have been previously solved, 9 md is 
found in the same fashion. Hence, we can solve iteratively for the higher derivatives, and boundedness 
of the signals is guaranteed for any bounded desired output trajectory. 


Example 5.6 A common case for which we can solve for the feedforward is as follows. Assume that the 
inertia of the motors is symmetric about their axis of rotation (Section 3.2.2), and that k\ is defined as 
follows 


9m) 


fi(N x 9 u - 9 mi ) i = j 
0 i ^ j 


i,j = 


(5.32) 


where Ni and fi are respectively the gear ratio and the elasticity characteristic of the ith joint. If all 
the /i’s are monotonically increasing, continuous, differentiable, and their range is R, then k\ is globally 
invertible. 


Equations (5.29, 5.30) may be written as 

0 = ge(0 f J + Nk l (9e d Jm d ) (5.33) 

U g = ( 5 - 34 ) 

and a unique solution, 9 m<t , to (5.33) can be found for any 9( d and is given by 

e md = N9 (d - fcf 1 (-N- 1 ge(9 td )) (5.35) 

We obtain ug by substituting (5.35) into (5.34) which gives, after simplification: 

ug — ^~ 1 9e{9( d ) 

□ 


Note that for the previous example without the motor symmetry assumption, a local result may be 
obtained under proper assumptions. 
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5.8 Solution of FF8 


Expand FF8 to obtain 

0 = 9 m ) + RnO( d + R\iQm d (5.36) 

Ug = + R-22^m d (5.37) 

To compute the feedforward control input ug from (5.37) for a given 9 (d , we assume that 9 ( and 9 m are 
available for measurement and the reference position 9 md must be defined. 

Assume that R is chosen with Ru nonsingular, we obtain 9 md from (5.36): 


9 md = -Ri2-\[fi(»eJm) + Rn0t d ) 

We obtain ug by substituting (5.38) into (5.37): 

ug — f 2 (9e,9 m ) 4- R2\&t d ~ RiiRi2~ l &m) + R\i^t d ] 
ug = r 2 ( 9 f , 9 m ) - + [^21 ~ # 22 # 12 _1 #11 




(5.38) 


(5.39) 


and all the signals are bounded if Assumption 5.1 is satisfied. 

We see from (5.39) that if R is singular, then 0 td does not affect ug directly in certain directions. However, 
there seems to be no reasons at this point to restrict R to be nonsingular. 


Hence, solution of ug requires invertibility of fZi 2 , which is achieved by proper design, exact knowledge of 
r, i.e. gravity load and spring characteristics and measurement of motor and link position. Also, solution 
of the feedforward imposes no restriction on the structure of the system and on the system parameter 
values. 

However, the controller may require higher order derivatives of d m<i , in particular 9 m<i to implement a 
PD motor loop. Given 0 m<i is obtained by taking the time derivative of (5.38) assuming that fi is 
differentiable in both and 9 m and that measurement of motor and link velocity are available: 

L d = ~Rn~ l (Veri(9 e ,9 m )9+ R n 9 (d ) 

where V x fi(a:) is the gradient of f x with respect to x. Note that the condition of differentiability of 
r x implies a similar condition on r x , i.e. on the spring characteristic itself. For boundedness of 9 md , 
Assumption 5.2 is required. 


6 Controller design for tracking 


In this section, we carry out the controller design, i.e. error system stabilization, for the error system 
formed by using using FF4 and FF6 defined in Section 5.1 in order to demonstrate the application of 
the procedure established in Section 4 and to present some stability results and design requirements. We 
recall that the procedure allows to ascertain asymptotic stability for the system by using any controller in 
the of strictly passive and BIBO stable controllers if we can show that y v 0 and if the zero-state 
detectability condition is met. 

6.1 Stabilization of error system formed by FF4 

For FF4 with C represented using Christoffel’s symbols (Section 3.1), define 

U = u a + Ug 

to obtain the following error equation for the system : 

M(9)A9 + C c (9j)±9 + D(9) - D[9 d ) + RAO = Bu Q (6.1) 
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0.1.1 Static feedback 


Li 

y 




i 

m 


In Appendix B (Section B.2), we show that the use of the motor position as part of the output may allow 
to obtain stable zero dynamics for flexible joint robots, implying at least weak zero-state detectability, 
and also to render the system passive if, for example, the motor velocity is also part of the output (see 
case 1 of Section B.2). This motivates the following design. 

Consider a static feedback of the motor error state ( C p (y p ) = K P B T A9 ): 

u 0 = «i — K P B T A9 

The closed loop error equation becomes: 

M{9)A9 + C c {9 , 9)A9 + D(9) - D{9 d ) + [r + BK P B T ] A 9 = Bu x (6.2) 

Proposition 6.1 The pair ( , B T /±6) is a passive pair for the error system if the two following assump- 
tions are satisfied: 

Assumption 6.1 R and Ii p are chosen such that > 0. 

Assumption 6.2 There is no negative damping in the system. 

Proof : In order to show passivity, consider the following energy function based on the total energy of 
the error system 

v = ^A 9 t [r + BK p B t ] A 9 + ^ A9 t M{9)A9 ( 6 . 3 ) 

Using (6.2, 6.3) and the fact that {\M - Cc ) is skew-symmetric, we obtain 

V = A 9 t Bui - A9 t \D{9) - D{9 d )\ (6.4) 

Evaluate the time integral of (6.4) : 

V(t) - V(t 0 ) 

[ A9 t Bu\ dt 
Jt o 

Assumption 6.1 implies that V is positive definite, and Assumption 6.2 implies that 

A9 t \D{9)-D{9 d )] >0, V9,9 d 

such that (6.6) satisfies the condition for passivity (Definition 2.6). ■ 

Note that the position feedback is not required in general to guarantee passivity, e.g. the spring coupling 
matrix for manipulators with linear flexible joints may be used to define R which then takes the form 

-Ii e N ' 

A'c 

and is then positive semi-definite (K e is positive definite). However, the position feedback is useful to 
guarantee (weak) zero-state detectability (Section 7). 

Also note that the system remains passive in the absence of friction, i.e. if D(9) = 0. 


[31] 


R = 


Ii’ e N 2 

-Ii e N 


f A9 t Bu x dt - J* A 9 t [. D{9 ) - D{9 d )\ dt 
V{t) - V(t 0 ) + f A 9 t [D(9) - D{9 d )\ dt 


(6.5) 

( 6 . 6 ) 
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Moreover, assumption 6.2 could be relaxed by employing the factorization 

D(6) = DiW + Dtf (6.7) 

and replacing D(9 d ) in the feedforward by D x {9) + D 0 9 d , D 0 > 0, assuming that the feedforward is 
solvable. 

Then, ^£>(0) - £>(#<*)] is replaced by £>oA0 in (6.1, 6.2, 6.4, 6.5, 6.6) such that due to the positive 
semi-definitiveness of D 0 , only Assumption 6.1 is required to guarantee passivity. 


6.1.2 Strictly passive feedback 


Choose 

«i = ti 2 -C V (B T A9) (6.8) 

where C v is strictly passive and BIBO stable. Then, by the Passivity Theorem (Section 2), the map from 
u 2 to B r AO is £ 2 stable. 

The closed loop error system is given by 

M(9)A9 + Cc{9, 9)A9 + D{9) - D{9 d ) + [R + BK P B T ] A 9 + BC V (B T A9) = Bu 2 (6.9) 


and, using the same energy function V as before (6.3), 


V = A9 t Bu 2 - A 9 t \D{9 ) - D(9 d )] - [b t A9] C v (B t A9 ) 


( 6 . 10 ) 


Proposition 6.2 If u 2 — 0, w€ can conclude that (A9,A9^ converges to the largest invariant set in 
{(A9,A9) : B t A9 = 0} for ( 9 d ,9 d ) uniformly bounded. 


Proof : Recall that the strict passivity of C v means 


f w T C v ( w) dt > - 7 2 + 7 1 
Jto 



( 6 . 11 ) 


for any T > t 0 , w € £ 2e , where 7/ > 0 is a constant, and the constant 7 depends on the initial condition 
of the internal state of C v . Using (6.11) and integrating (6.10), we have 


V (A$(T),A9{T)) - V (A9(t 0 ),A9(t 0 )) 


< 


- f T A9 T (t) [D(9{t))-D(9 d (t))} 

J to J 


dt 


From this inequality, we conclude that F(A^,A^) is uniformly bounded. Also, positive definitiveness of 
V implies that A 9 and A^ are uniformly bounded. By (3.31), the Coriolis and centrifugal force term in 
the error equation (6.9) is bounded above in norm under the assumption that 9 d is uniformly bounded. 
Hence, given the BIBO stability of C v , we conclude from (6.9) that A 9 is uniformly bounded. Uniform 
boundedness of 9 d must also be assumed in order to guarantee uniform boundedness of the feedforward. 
Uniform boundedness of AS implies continuity of A<?, which, along with the fact that B T A9(t) € £ 2 , 
lead to the conclusion that B T A9(t) -*• 0 asymptotically by Barbalat’s lemma [25]. ■ 

Furthermore, assume that 9 d € C k , k > 2, and that D e C k ~ 2 (no Coulomb friction or exact compensation 
of the discontinuous terms). Also consider the fact that M{9) and Cc(0, v) are functions of sin and cos, 
and are uniformly bounded as well as all their higher time derivatives if v and its higher derivatives 
are uniformly bounded. Then, by taking successive time derivatives of (6.9) and from (A0 = 9 - 9 d ), 
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we find that all higher derivatives of AO up to its (k - l) th derivative are uniformly bounded, and all 
higher derivatives of B T AO up to its ( k - 2 )th derivative tend to zero asymptotically. This last result 
will be useful in the demonstration of zero-state detectability where the convergence to zero of the higher 
derivatives of B T A0 is needed. 


Proposition 6.3 The zero error state of the system with strictly passive BIBO stable feedback C v and 
for ii 2 = 0 is (locally) asymptotically stable under the following assumption 


Assumption 6.3 B T AO is (locally) zero-state detectable in (AO, AO) with respect to the following equa- 
tion: 

M(9)A0 + C c (0, 0)A0 + D(0) - D(0 d ) + [R + BK P B T \ AO = 0 


If the detectability is global, then so is the asymptotic stability. 


NOTE : conditions for (local) zero-state detectability will be given in Section 7. 

Proof : Proposition 6.2 and the BIBO stability of C v imply that 

ui = C v (B t A0) - 0 

Substitute this result in (6.2) to get that for B T AO -* 0 asymptotically, 

M(0)A0 + C c (0, 0)A0 + D(0) - D(0 d ) + [fl + BIC P B T ] AO — 0 

If B t A0 is (locally) zero-state detectable in (AO, AO) with respect to this equation, then, (AO, A0) — * 0 
and the error state of the system is (locally) asymptotic stable. ■ 


6.2 Stabilization of error system formed by FF6 

The design procedure and requirements for the use of FF6 (C is represented using the Mo-notation 
(Section 3.1)) are the same as for FF4 in Section 6.1. However, given the new error equation with static 
position error feedback 

M(0)A0 + C d (0,0)A0 + \M D (0,0)Q d - \M D (0,Q d )0 + D(0 ) - D(0 d )+ 

[r + BK p B t ]aO = Bu x (6.12) 

property (3.25) is used to evaluate the time derivative of V (6.3) to be (6.4), and to be (6.10) after the 
strictly passive feedback is added. 

Also, identity (3.30) is used to bound the Coriolis and centrifugal force term in the new error equation 
for Proposition 6.2 to hold. 


7 Zero-state detectability 

In this section, conditions for zero-state detectability are defined for feedforward FF4 with C represented 
using the ChristofFel’s symbols and for FF6 in which C is represented using the Mp -notation. In essence, 
we want to show that in (6.2), (6.12), if the passive output B T AO and the input u x are zero then the 
internal state of the system is zero, or tends to zero for weak zero-state detectability (Section 2). 

7.1 General result with link damping 

For FF4, consider the error equation (6.2), and the scalar function V (6.3) and its derivative V (6.4). 
We want to use V to demonstrate that the link state error tends to zero asymptotically. Suppose that 
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Assumption 6.1 holds. After setting u u and B T 9 to zero, we get, for the general model, 

V = ^A9 t [r + BK p B t ] A 9 + ^A9f M u (0 ( ,6 m )A9 e 

We note that V is positive definite in A9 e . In order to have V positive definite in A 9g with A 9 t = 0 at 
its minimum, choose R such that Ru = -Rii 7 (recall that R u > 0 to satisfy Assumption 6.1). We also 
have 

V = -A 9 t [D(9) - D(9 d )] 


Hence, if there is positive link damping, V is negative semi-definite and A0{ — ► 0. Substituting this 
result along with the assumptions on u\ and B T A0 in (6.2), we obtain 


R + BK p B t 


A 9 = 


0 


which leads to the conclusion that AS -* 0 by Assumption 6.1, implying that the internal state converges 
to zero. 

Hence, for any arm configuration and in presence of positive damping at the links, the system is weakly 
zero-state detectable (globally) if Assumption 6.1 is satisfied and if we choose R such that Ru = —R 2 i T - 

The same conclusions are reached for FF6 by using the same procedure. 


7.2 Results without link damping 

In order to assess (weak) zero-state detectability, or zero-state detectability, in the absence of link 
damping, we use a different approach than in Section 7.1. This will allow us to obtain a general conclusion 
along with some positive results for some general cases. 

NOTE : As seen in Section 7.1, («i, B T A0, A6() = (0,0,0) implies that A 8 e is zero, and hence the 
internal state is also zero. 

Consider the error equation of the system (feedforward FF4) with static feedback only (6.2). For the 
general model (3.10), after setting u x = 0, and A S m and its higher derivatives to zero, (6.2) simplifies to 

Mn(9 e ,9 m )A9e + C n (e e ,9 e ,9 m J m )Ad e + De(9 e )-D e (9 ed ) + R n ^e + Ri2^m = 0 (7.1) 

Mui^t, 9m)A6t + C 2 i{S(, 9(, 9 m , 9 m )A9( + R^iAOf + I?22A0 m + Ii p A9 m = 0 (7.2) 

Then take the time derivative of (7.2) to get, at A 9 m = 0, 

Mi 2 (9e, 0 m )A0^ + M x2{9t,9/>,9 m , 9 m ) A 9 t + (?2i(^, 9 e , 9 ni , 9 m )A9 t: 

+C 21 (9 e j e j ( ,9 m j m ,9 m )Mt + R-2iMe = 0 (7.3) 

For FF6 we may write similar equations. 

RESULT : If (7.3) is asymptotically stable (A&e -► 0) then the system is at least weakly zero-state 
detectable and a similar conclusion is obtained for the equivalent equation obtained with FF6. 

We now consider three general cases for which we seek conclusions on zero-state detectability. 

Case 1: Mu = 0 

For Mu = 0 and under the additional assumption that the motors are symmetric or that M u is inde- 
pendent of the motor position, (7.3) becomes 

R 21 A9 c = 0 (7.4) 
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such that, for R 2 1 arbitrary but nonsingular, A9 ( and its higher derivatives equal zero and, as noted 
previously the internal state is also zero, i.e. we obtain global zero-state detectability. 

NOTE : If Mu depends on the motor position, then we may still be able to conclude zero-state 
detectability depending on the structure of C 2 \. 

The same procedure may be used for FF6 and leads to similar conclusions. 

Case 2: M 12 is singular but non-zero 

We will particularly consider the case when the motors are symmetric and M i2 is strictly upper triangular 
as an example (Section 3.2.3). 

For FF4, (7.3) becomes 

M( 2 (9 t )A9 { f' ) + Mi 2 {0( 7 9()A9 e + C 21 (9 e ,9 e )A9 t + C 2 i(9 e , 9 t , 9 e )A9 e + R 2 \A9 t = 0 (7.5) 

where Afj£, C 2i and their time derivatives are strictly lower triangular (Appendix A). Then, choosing 
R 2 1 to be lower triangular (or diagonal) and nonsingular, it follows from (7.5) that A9 ( = 0 (recursively 
solve for A9 ti , i = 1, ■ • • , m), also implying A9 e = 0. 

As seen before, A 9 = A9 = 0 implies that the internal state is zero, and the system is globally zero-state 
detectable. 

However, without the symmetric motor inertia assumption, C 2 \ may not be strictly lower triangular such 
that zero-state detectability may not be shown in the same fashion. However, depending on the new 
structure of C\ 2 , we may possibly show weak zero-state detectability. 

For FF6, the derivative of the motor equation with (tti, B T A9, A9() = (0,0,0) is 

Mj 2 (0t)A9^ + Mi 2 (9i,9t)A9t + C 2 i(9(, 9()A0( + C 2 i(9e,9(,9t)A0t - -MD,2i(9t,9e)A9( 

~M D , 21 ( 6 t,9t,0t) A9 ( + \M D ,<n{0 t ,A9 t )9 t + ^M D , 21 (<M<, A9 t , A9 t )9 ( + R 21 A9 e = 0 (7.6) 

where M? 2 * Cii,M Dy2 i and their time derivatives are strictly lower triangular (Appendix A). Also, row 
i of Mp t 2i(0*, A&t) depends only on j < i for i = Then, choosing jR 2 i to be lower 

triangular (or diagonal) and nonsingular, it follows from (7.6) that A^ = 0 (recursively solve for A^ t , 
i = 1, 2, ...m), also implying A^ = 0. 

As seen before, Af? — A6^* = 0 implies that the internal state is zero, and the system is globally zero— state 
detectable. 

Case 3: M\ 2 is nonsingular 

At this point, we have no results on the zero-state detectability of the system if M\ 2 is nonsingular. 

8 Stability analysis under feedforward approximation 

The design approach presented in Sections 4 and 6 allows to obtain a complete class of controller guar- 
anteeing uniform asymptotic stability for systems meeting all the design conditions. Such a case for 
flexible joint manipulator is when motors are symmetric and there is no gyroscopic coupling guarantee- 
ing solubility of FF4 and of FF6, and zero— state detectability under some additional design assumptions 
(Sections 5, 6 and 7). But if for some feedforward we cannot verify (weak) zero-state detectability, we 
cannot draw any conclusions about the system stability at this point. This may append in particular if 
an approximation of the exact inverse system based feedforward is used. 

If for some canonical feedforward ail conditions are met except possibly the solvability condition (no 
causal and bounded solution), then we can draw some information from the stability properties of the 
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system under the canonical feedforward to analyze stability under other forms of feedforward. To do so, 
we use the identity that uniform asymptotic stability implies local exponential stability. We then consider 
the variations in the feedforward as perturbations and find the bounds on these perturbations allowing to 
maintain stability for the feedforward under analysis, i.e. we perform a robustness analysis with respect 
to the variation of the feedforward (see [36] for the application of this method to rigid robots). 

We will use this approach to analyze the stability of the different feedforward forms by using FF4 and 
FF 6 as canonical feedforward compensations. However, we first introduce the formal procedure. 

8.1 Procedure 

Assume that with some canonical feedforward the zero error equilibrium point is locally exponentially 
stable. Then, locally to (Ad, Ad) = (0,0), there exists a scalar function Vi, Vi = 0 for (Ad, Ad) = (0,0), 
and constants (a , /? , 7 > 0 ) such that 

Vi>a||x-|| 2 (8-1) 

Vi < -7 INI 2 ( 8 - 2 ) 

|| V, Vi II < jS M (8-3) 


where 1 = [ A d T A 0 T . 

Proof : To see how these conditions lead to exponential stability, note that (8.3) along with V% — 0 for 
(Ad, Ad) = (0, 0) imply that for some constant k > 0, 

Vi<k|]z || 2 (8-4) 


where we may choose k = ^ : write 

px I r ^ I rlMI Q , 

v x = V,Vi(0«ie < I jf V,Vi(0rff| < jf ||V,Vi(0|| de < | ||z|| 

Combine this result with (8.2) to obtain 

Vi < -crVi 


where a = Now write (8.5) as 


0 ) 


d 


Vi + o Vi 

^(t-<o)vi) 

dt 


< 0 

< 0 


(8.5) 


Integrate this last equation to get 

V x (*,Ad(t),Ad(0) < e-'V-V [Vi(t 0 ,Ad(to),Ad(t 0 ))] 

i.e. local exponential stability with rate of convergence larger or equal to <7 is obtained. ■ 

Write the different forms of feedforward, ug , in terms of the canonical feedforward, uj / c , and of a variation 


term, e, as 

Bug = Bujj c + e 

Now consider a scalar function V 2 = Vi . The time derivative of V 2 along the solution of the system with 
the various forms of feedforward is 


V 2 = Vi + [V^V'i ] 7 M~ l (v)e 


( 8 . 6 ) 
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where M(v) is the multiplier of A0 in the error equation of the system with the canonical feedforward, 
e.g. M(0) in (6.9) for feedforward FF4. Write 


v 2 < Vi+ |[V^U] r M- 1 (t;)e|| 


< V 1 + ~-|V A jVi|M| 

(8.7) 

Now use (8.2, 8.3) and note that ||V^Vi|| < ||V x Vi|| < 0 ||z||, to write 


v 2 < -7 Mil 2 + CIMI Ml 

(8.8) 


where C = Then, if the norm of the variation of the feedforward satisfies one of the two bounds 

* Q( fyf ' 

described below, we can assert stability of the system under the new feedforward. 


Case 1 : Assume that for some constant x > 0> 

Ml < x Ml ( 8 - 9 ) 


Then, using (8.8), we obtain 

Vi < -(7 -Cx)INI 2 


Hence, exponential stability with guaranteed rate of convergence <J\ > 0 is obtained if the variation of 
the feedforward is small enough in the sense that 



X < ? 

(8.10) 

and using (8.4), a\ is given by 


7 ~ Cx 

<7 1 - 

AC 

(8.11) 

Case 2 : Assume that for some constants { x,p) > 


Then, using (8.8), we obtain 

Ml <x 11*11 + p 

(8.12) 

V 2 < 

- (7 ~ Cx) ll*ll 2 + Cp Mil 

(8.13) 

Write 



CP 11*11 = “C P 

(«-' IW-5«) > -«- J IWI 1 -x 

(8.14) 

Substitute (8.14) into (8.13) to get 

V2<-( 

7 - Cx - Cpf 2 ) Mil + 4 

(8.15) 

which, using (8.4), is written as 



where 

V 2 ^ —<72^2 + p2 

(8.16) 


1 

1 

CT 

1 

'*< 

1 

vT'', 

1 

to 

(8.17) 

" 

to 

II 

I to 

(8.18) 
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Now write 


< P2 


Vi + O' 2 Vi < Pi 
d ( e ^lt-t 0 )y\ 

-<r 2 (i-(o)_\ L 

(It 

Integrate this last equation to get 

V 2 (t,A8(t),A9(t)) < 


P 2 


Vi(t 0 ,A8{t 0 ),A8(to))- ^ ^ 


02 


P2 


O 2 


Assume that the variation of the feedforward is small enough in the sense that (8.10) holds such that 
a 2 > 0 for € 2 > where 


e 


2 

m 


0? 

7 - Cx 


Define the supremum of Vi over t as 

V 2 = max|v 2 (t 0 , A0(<o), A^(<o)),^| 

Since V 2 is positive definite, this implies that the state remains bounded, i.e. we obtain Lagrange stability. 
Also, convergence to the set ^A$(t), A9(t) : V 2 < with rate of at least <z 2 is guaranteed. Note that 
choice of a large e guarantees a fast convergence to a large set, while choice of a smaller e > e m > 0 
does not guarantee such a feist convergence but guarantees convergence to a smaller set, i.e. the state 
converges closer to zero. 

Following closely this approach tends to give conservative bounds on ||e||. In practice, one may evaluate 
explicitly V 2 using (8.6) and use directly V 2 and V 2 to find relationship (8.16) and hence obtain less 
conservative bounds. 


8.2 Exponential stability of canonical feedforward 


Uniform asymptotic stability of the system under the canonical feedforward with any strictly passive 
BIBO stabilizing controller implies local exponential stability. However, it is difficult to explicitly con- 
struct V) in (8. 1,8.2, 8.3) in general. One case for which we can explicitly construct V) is if there is 
damping at the links, case that we will consider here. 


We do not provide a demonstration for a general strictly passive controller C v but for a simple case, i.e. 
C v (B T A0 ) = K V B T Ad (the global controller structure is feedforward with proportional-derivative (PD) 
controller). Also, for the demonstration, we will assume that only a linear damping term, D 0 A9, appears 
in the error equation (see (6.7)). 


Proposition 8.1 Consider a flexible joint manipulator with linear damping at the links Di 0 > 0. Assume 
that feedforward FF4 with C represented using Christoff el’s symbols or feedforward FF6 is used. Also, 
close a static state error C p (y p ) = K P B^ A9 and a strictly passive BIBO controller loop C V {B^ A0) — 
K v B t A 9 where the gains are chosen to satisfy Assumption 6.1 and the following assumption: 


Assumption 8.1 K v are chosen such that Dq + BR V B ^ 


> 0. 



Then, for 9j sufficiently small in norm, the zero error equilibrium point is locally (to A0 — 0) exponentially 
stable. 


Proof : Consider the following energy based Lyapunov function candidate where the last term is used 
to cancel extra terms introduced by the cross term in A 9 and A 9: 


Vi = -A 9 t [R + BK p B t \ A 9 + cA9 t M(9)A9 + ±A9 T M(9)A9 + |a 9 t [d q + BK V B T ] A 9 (8.19) 
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Evaluate the time derivative of Vi along the solution of the system given by its error equation ((6.9) for 
FF4, and (6.12) plus the stabilizing loop for FF6) to get, using the properties listed in Sections 3.1 and 
3.3, 

V x = —cA9 T [fl + BK p B t ] A 9 + cA9 T [m{ 9, 0) - C c (9 , <?)] A9 

-A9 T [Dq + BIC v B t - cM(9)] A 0 + (cA0 T + A 0 T ) Bu 2 (8.20) 


for FF4 where used the 


skew-symmetry property 


of ^M(0,9) - C(0, 0)) and 


we assume U 2 = 0, and 


V x = -cA9 2 


\r + BK V B t ] 


A 9 


+cA9 t ^.M(#, 9)A9 — Cd(9,9) A9 — — A/p(0, #)#<* + ~^Md{9 ,9<i)9 
-A 0 T [Dq + BK v B t - cM{9)\ A 9 + (cA9 T + A9 T ) Bu 2 

for FF6 where we used (3.25) and also assume u 2 = 0. 

We now proceed to show that Vi and V\ satisfy (8. 1,8.2, 8.3, 8.4). 

Lower bound of Vj (8.1) : From (8.19), we have 


1 , . X „ . „„2 ■■ • - II • All . 1 


Vx > i (a„ + ca v ) \\A9\\ 2 - c lM \\A9\\ | A9\\ + -a M | A 9 


m2 


for c > 0. Write the cross term as 


- c-fM || A0|| 


AS 


HM 


(<1 ||A«|| - ef 1 ||Afl||) 2 - <?, ||A0|| 2 - tf 2 ||a» 


such that, using (8.23) in (8.22), Vi satisfies 


Vx > qx ||A0|| 2 + a 2 


A 9 


> llx| 


1 / 2^ 

1 ( -2\ 

Ql = - («p + ca v - cim* X ) 

a 2 = - - c~fMt\ ) 


where 


a = min {ax, 02 } 

Proof : of the last inequality. Write, for the 2 - norm, (we assume a x and a 2 nonnegative) 

1 2 


a i l|A^|| 2 + a2 


•. 11 2 


A0 = 


s /a[A9 

V^A 9 


> min {ax,a 2 } ||i|| i 


which concludes the proof. 

To guarantee positive definitiveness of Vi, we impose ax > 0, a 2 > 0 yielding 


c 7 M „ 2 „ a p “b COlv 

< e x < 


&M 


ClM 


( 8 . 21 ) 


( 8 . 22 ) 


(8.23) 


which, for a nontrivial solution requires 


ClM Op + COty 
ClM ClM 
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This is satisfied for c small enough, i.e. 0 < c < c v where 


_ ctA/at, ( a 2 M al 2 

CU 2 7 1 V 4 7a/ ill ) 


(8.24) 


Upper bound of V± (8.4) : From ( 8 - 19 )> we have 


Vi < \ (ip + c iv) l|A 0|| 2 + c 7m \m\ ||a 0 || + i 7A/ ||a 0|| 2 


Write 


c 7 a/ [|A0|| |a# = [ — ( e2 l|A^H — e 2 1 || A^l) + € 2 l|A^|| + f 2 2 ||a^| 

such that, using (8.26) in (8.25), V\ satisfies 


(8.25) 


(8.26) 


V\ < K! ||A0|| 2 + k 2 A 9 < k||x|| 


where 


Ki = | ( 7p + C 7v + C 7 Af€ 2 ) >0 K 2 = - ( 1M + C 7 A/£ 2 2 ) > 0 


k = max {ki, /c 2 ) 

Proof : of the last inequality. Write, for the 2 — norm, 

r 1 1 2 

Ki [|A0|| 2 + k 2 I A<?| 2 = < max{Ki,K 2 } ||z|| 2 

which concludes the proof. m 

Hence, Vi is upper bounded for any bounded c. 

Upper bound of V Afj Vi (8.3) : Vi being lower and upper bounded by quadratic functions, and con- 
tinuous, the norm of the gradient of Vj with respect to its argument is also bounded. Evaluate explicitly 
the gradient of V\ with respect to A# from (8.19) : 

V A gVi(A0, A9) = cM(9)A9 + M(9)A9 (8.27) 

such that 

||V^Vi|| <fa ||A#|| + 0 2 || A#| < 0 ||z|| 

where 

0\ = C~jM >0 0 2 = 7A/ > o 

0 = 01+02 

Proof : of the last inequality. Write, for 0\ and 0 2 nonnegative, 

01 ||A0|| + 0 2 ||a^|| < ft ||x|| + 02 ||x|| 

which leads directly to the bound in 0. ■ 

Upper bound of Vi (8.2) : Use (8.20) and property (3.33) to obtain, for FF4, 


V\ < -ca p |[A0|| 2 + c 7 c 2 ||A0|| A 0 2 + c 7Cj ||A0|| ||a<9|| |^| - [a v - c 7m ] 


A9 


(8.28) 
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and use (8.21) and property (3.27) to obtain, for FF6, 


Vi < —ca p ||A0|| 2 + c-7£> ||A0|| 


A8 


+ c-7d||A0|| A 9 


- [a v - c^m] 


A9 


Identify 7/ with 7 c 2 in (8.28) and 7/ with §7 d in (8.29) to write, for both FF4 and FF6, 


Vi < -ca p ||A0|| 2 + 07/ ||A0|| A 9 + 07/ ||A0|| ||A0 8 d - [a v - 07^/] 


A 9 


We will use this last equation to find conditions for the negative definitiveness of V \ . 
For negative definitiveness of Vi, we first need 

cap > 0 and a v - c-fM > 0 
Due to Assumption 6.1, this is satisfied for 0 < c < c*i where 


oc„ 


C2 = 


7 M 


(8.29) 


(8.30) 


(8.31) 


Then, use 


A 8 




8 d 


— (^3 ||A0|| — €3 1 ||A0||) 2 + €3 ||A0|| 


12 + < 3 - 2 


Ad 


to get 


Vi < — c 




8 d 


l|A0|| 2 + c~u ||A<?|| 


A 8 


7/ -2 

«v - H m - c— e 3 


N 


a e 


Assume that ||A#|| is uniformly bounded above by 7 e such that 

o v - C7A-/ - C7/7 e > 0 


and that 


where 


is uniformly bounded above by 7^. Then 


V x < -7r ||A0|| 2 -72 


A 9 


<-7lW 


71 = c \a p - y t\ld 
7 = min {71,72} 


7/ -2 

72 = a„ - c~fM - citfe - 7<i 


where we assumed 71 and 72 positive. This last condition is satisfied and V\ is negative definite if 


c^7± 


_ < e 2 < a P 
- C 7M - c 7/7e 3 ^-7d 


For a non trivial solution, we need 


cjjld Op 

otv - CJM - C7/7? ^7 d 


Hence, 7^ must satisfy 


2 

Id < — 

ll 


f a P ( Q » ~ c lM ~ c 7/7e) 1 
0 


(8.32) 
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Summary : Conditions (8. 1,8. 2, 8. 3) 
relation (8.32) for 


are satisfied if A0 and 9 d are small enough in norm and satisfy 
0 < c < min {c„,c 2 } 


where c v and c 2 are respectively given by (8.24) and (8.31). 


may ascertain a rate of convergence larger or equal to o — Note that a better evaluation of the 
convergence rate is given by a = min ^ j. 


Also note that (8.32) indicates that an increased supremum of the norm of 9 d reduces the allowable bound 
7 e such that the region of convergence decreases. 

Moreover, we obtain similar qualitative results for both FF4 and FF6 and the effective difference would 
show up in the evaluation of the bounds through 7/. 


8.3 Stability for various forms of feedforward 

We now conclude on the stability with the various forms of feedforward by using the results of the previous 
section on the exponential stability of FF4 and FF6. 

The variation terms e for the different forms of feedforward with respect to the canonical feedforward 
depending on the canonical feedforward used, we will consider separately the analysis based on the 
results for FF4 (representation of C using Christoffel’s symbols) and for FF6 (representation of C using 
Mp-notation). 

NOTE : In order to obtain a better bound on the variation of V 2 than in (8.7), explicitly evaluate (8.6) 
using (8.27) or equivalently by identifying Bu 2 with e in (8.20) : 

V 2 = Vi + (cA0 r + A0 r ) e 
< Vi + (c ||A<?|| + ||a 0|P ||e|| 

where we may use (3 ; =s (c + 1). We then identify £ with ft in (8.8), 


8.3.1 FF4 as the canonical feedforward 

The variation terms e for the different forms of feedforward with respect to the canonical feedforward 
FF4 with C represented using Christoffel’s symbols are given by 

FFl. e = [M(6 d ) - M{9)] 9 d + [< C c (0 d , 9 d ) - C c {0 , 9)} h + f{9 d ) - f{9) 

FF2. e = [M(9 d ) — M(9)]9 d + ^Cc(9d,^d) - Cc(0i^)] ^ d 
FF3. e = f(9 d ) - f(9) 

FF7. e = -M(0)9 d - C c (6JWd - D 0 9 d + f(9 d ) - f{0) 

FF8. e = -M(0)9 d - C c (0j)6d - D o 0 d 

We did not consider FF5 and FF6 because C is not represented by the same notation as FF4. 

The norm of the variation e can be bounded above by 
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FFl. 


||e|| < | [M(9 d ) - M(9)\ 9 d \\ + || [■ C c {9 d , 9 d ) - C c {9 , 9)] 9 d || + \\f{9 d ) - r(0)|| 


< ID 


9d 


|A0|| + ic ||0d 
I A 9 


A^ + ir ||A0|| 


11^1 || A^|| + led 

= (iDldd + ~fCdl d + 7fi) ll^^ll + ICld 
where we used (3.26, 3.34, 3.35). 

FF2. ||e|| < \\[M(9 d )-M(9)^ + \\[Cc(9 d ,9 d )-C c (9j)}9^\ 

< ID H IIA«II + led + 1C 

= (iDldd + ICdll ) ||A0|| + ICld 

where we used (3.26, 3.34). 

FF3. ||e|| < 7 h||A0|| 


9 d 


A 9 


A S' 


where we used (3.35). 

FF7. ||e|| < ||M(^)^|| + ||C , c(^,^)^|| + ||£ , o^|| + ||r(^)-j : WII 


< 7m |^'<i|| + 7C 

= 7k||A0|| + ICld li A<9 

where we used (3.31, 3.35). 

FF8. j| e || < | Af(^ d || + 1^,^11 + 11^0^11 


+ ic ||0<f|| || A<9| + i Do 11^1 + 7 R l|A0|| 

+ {iMldd + ICld + iDold) 


< 1M Pd +7C pJ +7C \\9 d A0 +7D 0 


= ICld 


A 9 


+ {iMldd + 7C7rf + IDold) 


where we used (3.31). 

The variation, of the feedforward signal e for FFl, FF2 and FF3 may be written in the form of (8.9), 
while for FF7 and FF8 it may be written in the form of (8.12). 

The conclusions on the stability and performance for the different forms of feedforward are summarized 
in Table 1. Achievable type of stability, and qualitative conditions on design parameters for stability, 
for fast rate of convergence and for smallness of the convergence set (for Lagrange stability) are listed in 
the table. We recall that to guarantee stability, we require that <J\ in (8.11) or in (8.17) is positive 
depending on the form of the bound on the error signal and that a faster rate of convergence is obtained 
as these variables increase. For the Lagrange stability, convergence to a smaller set about the zero error 
state is guaranteed as p 2 decreases in (8.18). 


8.3.2 FF6 as the canonical feedforward 

The variation terms e for the different forms of feedforward with respect to the canonical feedforward 
FF6 are given by 

FFl. e = [M(9 d ) - M(9)]9 d + [c D {9 d ^ d ) - Co(M) + \M d {9,9 )] 9 d - \M D ^,9 d )9 + f(9 d ) - f(9) 
FF 2 . e = [M{9 d ) - M{9)]9 d + [c D {9 d ,9d) - C D {9,9) + \M d { 9,9)\ 9 d - \M D {9,0 d )9 
FF3. e = \M D {9,9)9 d - \M D (9,9 d )9 + f(9 d ) - r{9) 
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Condition for 
stability: 
small enough 

Type of 
stability 

Condition for fast 
rate of convergence: 
small 

Condition for 
convergence to small set: 
small 

FFl 

(ld,ldd,lR) 

local exponential 

(ld,ldd,lR) 


FF2 

(id ,ldd) 

local exponential 

(id, Idd) 


FF3 

(7 R) 

local exponential 

(ir) 


FF4 


local exponential 



FF7 

(idi 1 r) 

Lagrange 

(id, Idd, 1 r) 

(id, idd.) 

FF8 

(id) 

Lagrange 

(id, Idd) 

(id, idd) 


Table 1: Stability and performance analysis, FF4 as canonical feedforward 


FF4. e = \Md{ 6, 9)9 d — 

FF5. e = f(9 d ) - r(9) 

FF7. e = -M(9)9 d - [C£>(M) ~ \Md( 8,9) h ~ \M D (9,9 d )9 - D 0 9 d + r(9 d ) - f(0) 

FF8. e - -M(9)9 d - [Cp(M) - \Md{8,9)\ - \M D (9,9 d )9 - D 0 9 d 

The norm of the variation e can be bounded above by 
FFl. ||e|| < ||[M(^)- M{9)]9 d \\ + \\[c D (9 d ,9 d )-C D (9 1 9) + \M D {9,9)\9 d - \M D {9,9 d )9 

II r(0 d ) - f(0)|| 

< 1D ffc|| ||A0|| + Dd ||^|| 2 ||A0|| + §70 ||4<f 1^1 + 7 R l|A0|| 

= (iDldd + \lDdl d + 7 fi) II A#|| + \lDld |a^|| 

where we used (3.26, 3.30, 3.35). 

FF2. ||e|| * 


+ 


|| [M(9 d )-M(9)]9 d 

+ | [c D (9 d ,9 d )-C D (9,9) + 

\M D (9,9)]9 d -\M D (9,9 d )9 

ID Qd 

||A(9|| + liDd 9 d II A6>|1 + \id 1^1 | A^| 



- ( 

where we used (3.26, 3.30). 


IDldd + \lDdlt) l|A^|| + \lDld |Al9 


FF3. 


\M D (9,9)9 d - \M D (9,9 d )9\\ + ||*W - f(<9)|| 

< 7d|MM|+7h||A0|| 

Afll 


= 1R ||A^|| + '/Did 
where we used (3.29, 3.35). 

FF4. ||e|| < \\\M D {9,6)9 d -^M D (9,9 d )9\\ 

< 7£j \§ d | a 0 

= iDld |A0 
where we used (3.29). 

FF5. ||e|| < ir ||A0|| 
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where we used (3.35). 


FF7. 


INI < |m(0)^|| + I [(?£>(M) - \M D (e,9)] 9 d + \M D {6,9 d )9\ + ||Do^|| + ||f(0«<) - f(0)|| 


< 1M 


9 d 


+ §7 D 


= 7k||A0|| + \lDld 


+ §7d||^ |a#|+7d 0 0rf|| + 7R l|A0|| 
A0 | + [iMldd + \lDld + lD 0 ld) 


where we used (3.28, 3.35). 

FF8. || e || < |M(^|| + | [c D (0,9) - \M D {9,9)] 9 d + \M D {9,9 d )9\ + \\D 0 9 d \\ 


< 1M 


&d 


= \lDld 


\lD 9 d + §7£> pdf | AS | +1D 0 


AS 


+ { 


iMldd + §7D7d + iDold 


) 


where we used (3.28). 

The variation of the feedforward signal e for FFl, FF2, FF3, FF4 and FF5 may be written in the form 
of (8.9), while for FF7 and FF8 it may be written in the form of (8.12). 


The conclusions on the stability and performance for the different forms of feedforward are summarized 
in Table 2. Achievable type of stability, and qualitative conditions on design parameters for stability, for 
fast rate of convergence and for smallness of the convergence set (for Lagrange stability) are listed in the 
table. 



Condition for 
stability: 
small enough 

Type of 
stability 

Condition for fast 
rate of convergence: 
small 

Condition for 
convergence to small set: 
small 

FFl 

(ld,ldd,lR) 

local exponential 

(id, Idd, ir) 


FF2 

{id, Idd) 

local exponential 

(7 df Idd) 


FF3 

(id, 1R ) 

local exponential 

(id, ir) 


FF4 

(7.) 

local exponential 

(id) 


FF5 

(ir) 

local exponential 

(ir) 


FF0 


local exponential 



FF7 

(id, ir) 

Lagrange 

(id, Idd, Ir) 

(id, idd) 

FF8 

(id) 

Lagrange 

(id, Idd) 

(id, idd) 


Table 2: Stability and performance analysis, FF6 as canonical feedforward 


8.3*3 Summary 

We see from Tables 1 and 2 that the conditions for stability and fast rate of convergence with the different 
forms of feedforward involve the upper bound on three parameters that can be affected by design : 

• Bounds {~fd,ldd) are made small by using a slow desired output trajectory {0t d and its higher 
derivatives). These bounds are also affected by the system parameters and by the parameters of 
the compensators through the solution of d Tn<i and its higher derivatives (see Section 5). 

• The bound 7 r is made small by choosing R giving the best fit of the gradient of the spring char- 
acteristic in the sense that sup{||XVr(0) — 7Z||} is minimized for R in the set of matrices meeting 

9 

the design requirements (Sections 5, 6 and 7). For a linear spring characteristic, this leads to 
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7fi = 0 if we may choose [r{6) - RO] = 0. Then, odd and even numbered feedforward forms become 
equivalent . 

9 Conclusion 

We have presented a controller design approach based on passivity and Lyapunov stability theory for the 
tracking of flexible joint manipulators. The overall design procedure may be viewed as consisting of two 
main steps described below. 

Firstly, compensators are designed by taking advantage of the inherent passivity properties of flexible 
joint manipulators. The procedure for the design of the passivity based controller involves essentially 
the formation of a passive and zero-state detectable error system by use of feedforward compensation 
and static state feedback, and the asymptotic stabilization of the system by using any strictly passive 
controller with finite gain. However, the feedforward compensation, which is based on plant inversion, 
may not have a causal solution, or it may be very difficult to solve for a stable inverse of the system due 
to its nonlinear nature, such that implementation of the controller is then compromised. Also, certain 
terms of the dynamical equation may have a negligible effect on the overall dynamics of the system, e.g. 
Coriolis and centrifugal effects at low velocities, such that we might want to neglect these terms in the 
feedforward. 

In the second step, we use stability results from the passivity based design, i.e. uniform asymptotic 
stability of the system implies local exponential stability, to analyze the stability of the system with 
various feedforward compensation. To do so, we conduct a Lyapunov based robustness analysis with 
respect to approximations in the feedforward compensation. This analysis allows to ascertain local 
asymptotic stability or Lagrange stability of the system under certain conditions involving bounds on 
the parameters of the system, and on other parameters that are affected by design such as the rapidity 
of the desired output trajectory. In order to obtain quantitative results, i.e. obtain numerical values for 
the bounds, we must explicitly construct a Lyapunov function (local) for the system, which may impose 
additional constraints on the system (we required the presence of damping at the links in our analysis). 

This design approach may be applied to both rigid robots and flexible robots. A particular case where this 
approach may be particularly useful is for the controller design of flexible joint robots with small, unmod- 
eled or badly known gyroscopic effects, so that inclusion of these effects in the feedforward compensator 
is not practical. 

Future work will tackle both theoretical an practical problems encountered in the control of flexible joint 
robots, and of flexible structures in general. Plans include 

• Analysis of the active use of the link state measurement in the design framework presented here in 
order to improve the performance of the system. 

• Design a nonlinear observer to estimate the link state based on the motor state measurement, since 
measurement of the link state is not available in general. 

• Design a saturation-driven trajectory generator in order to maintain stability and performance of 
the system in the presence of hard constraints, in particular of input torque saturation. 

• Pursue the validation of the results. 
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Appendix 


A Centrifugal and Coriolis matrix for M u strictly upper triangular and symmetric 

motor inertia 

In this section, we present the equations for the Coriolis and centrifugal matrix for flexible joint robots 
with symmetric motor inertia, and with the matrix of gyroscopic couplings Mu strictly upper triangular 
and having the following structure 

0 0 m 2 , 3 (^, 2 ) •" TO 2 ,m( 0 r, 2 , • • 1 ) 

Mum = : : : : : 

00 0 0 

where m,j are scalar functions. 

We recall that the mass matrix of the system can be represented as follows 

M(e t ) = 


Mu (Qe) Muifit) 

M&m 


and note that we will use 9 — [ 0e T 0 m T with 9t, 9 m € R 77 *. 

We will see that we may factor the Coriolis and centrifugal matrix as 

rfa « k k, _ c&iotm+c&mim) c&etm 

C(9e,0 m ,0(,0 m ) - C&mdt) 0 

where the individual terms of this matrix are defined below. 

A.l Equations for C represented using Christoffel’s symbols 

We recall that the coefficient of the Coriolis and centrifugal matrix are given by (see Section 3.1) 


G* - E? 


1 = 1 


dMkj dMki _ OMjj 

d0i + d$j d9 k J 


9 , 


(A.l) 


First, restrict (1 < k < m), (1 < j < m) in (A.l). After simplification due to the dependence of Mu, 
Mu, Mu uniquely on 9 ( and due to the fact that M 22 is constant, we can rewrite the equation as 

Cn,{k,j) — Cu(9t,9() + Cu(9t,9 m ) 


with 


1 

CtiiOtM = 


1=1 

m 


CfoteX) - E 5 


t=l 


dMmh,j){9t) dMinh, i)(9t) _ dA/n,(,,j)(^) 
dO ( ,i + d9 t j d9(k 

dM u ,( k ,i)m 

d9 (J d9 e , k 


8l, i 


9mA 


where we recognize as the Coriolis and centrifugal term of the rigid robot, and is 

skew-symmetric and has the following structure 

0 C\2 * ’ * * 1 — 1 i 8m, 3i ’ " i 8m t m) 

” ^ 12 (^ 1 ? * * • y ^,m-l i ^m,3> ‘ ? 8 mm ) 0 


CS(O e ,0 m ) = 


” c l(m-2)(^U i * i ” c 2(m-2)(^,2» ' ’ * * ^,m-1 5 i ^m,m) 

— C 1 (m— 1 ) (^,1 ^ * ' ■ Am-l! 8 m ,m ) ~ c 2(m-l)(^,2* ' ’ lj ^m,m) 

0 o 


41 


* ’ ■ ' > &t,m- 1 ; ■ ' ' ! ^m,m) 

C23(^f,2 >'") @(,m — 1 i ^m,4» ”'i 6m,m) 

~ c 3(m-2)(^>3) ”'i t > 6m, m) 

— c 3(m-l)(^,3> ‘ ’ t t 9 m,m ) 

0 

where c,j are properly defined scalar functions. We note that for t = l,---,m, row i of C® does not 
depend on any 6 m ,j, j < i. 

Now, restrict (1 < k < m), (m < j < 2m) in (A.l). After simplification, and defining p = j - m, we can 
rewrite the equation as 


c l(m — ’ ' '» Oe ,m — 1 j ^m,m) 0 

c 2(m— 1)(^,2 ? ’ * ’ j j ^m,m) 0 

* ’ ■ c (m-2)(m~l)(^,m-2> ^ , m — 1 ! 6m, m) 0 

0 0 

0 0 


C\ 2,(M = 


r .4 

C 12,(fc,p) 


= E? 


t'=l 


^■^12,(fc,p)(^) _ d^l2(i,p)(fr) 

<9^,, 




We note that for k > p, the elements of the matrix are zero such that this matrix is strictly upper 
triangular. 

Now, restrict (m < k < 2m), (1 < j < m) in (A.l). After simplification, and defining p = k - m, we can 
rewrite the equation as 


' 21, (p,j) 


r A 

°2i,(p,i) 


= E; 




1=1 


d9 ( . 


d9 t j 




We note that for j > p, the elements of the matrix are zero such that this matrix is strictly lower 
triangular. 


Now, restrict (m < k < 2m), (m < j < 2m) in (A.l). After simplification, we obtain 


C22 = 0 


A. 2 Equations for C represented using Mo-notation 

We recall that the coefficient of the Coriolis and centrifugal matrix are given by (see Section 3.1) 


C(M) = 


M D {9,v) = 




E 


9M(0) 

86, 


ve 


T 

i 


where e, is the unit vector in R n . 
Using (A.3), we obtain 

MD(9t,9e,6m) = 


Mg n (6(,9 ( ) + ME ilt (6 ( ,e m ) 0 


where 




m 


E 


dMn(^) 

Mt,i 


6(emJ 


(A.2) 

(A.3) 
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^Dy ll(^> ^ 7 

^ dMi 2 (9e) ■ j 

») = E M'. 


where em, is the i th unit vector in R m . 


Furthermore, using (A. 2), we have 


c&(0tM = 

M^ 11 (9 ( ,9 t )-^M^ n T (9 t ,9 e ) 

Cyi{9(,9 m ) = 

- \mE m t (9 t J m ) 

C&(9 t j e ) = 

-\M&, 2i T {9e,9 ( ) 

CA(9t,6 t ) = 



We note that Cf x {6t,Qt) is the Coriolis and centrifugal term for the rigid robot. Also, 




md\ , Q( t m - li $rn , 27 ’ * ' * ' > ^m,3i ’ ' ' 7 ^m,m) 

0 ^^ 22(^2 7 ' * * 7 — 1 1 ^m ,3 7 ' 7 ^m,m) 


0 

0 


0 

0 


^^ 13 ( 0 ^ 1 , * * • , 9t,m -\ i ^m t 47 ' ' ’ 7 ^m f m) 
7Tld23(^,2 7 * ’ • 7 ^,m- 1 7 ^m,4 7 ' ' ’ 7 ^m,m) 


, ’ * ’ , 0£,m-l 7 ^m,m) ® 

^^2(m — 1)(^2> ’ • ’ 7 ^m,m) 0 


0 

0 


md( m _ 1 )( rn _i)(^, m -l ; $m,m) 0 

0 0 


where md,j are properly defined scalar functions, so that for i = 1, * • • , m, row i of C^(^, 0 m ) does not 
depend on any @m,ji 3 — *'• 

We also note that Af$ 2 i(^> 9 t ) is strictly lower triangular such that C? 2 (9 e , 9 ( ) is strictly upper triangular, 
and C 2 i(9{, 9() is strictly lower triangular. 

NOTE : We note that the two representations for C considered here yield a Coriolis and centrifugal 
matrix with the same structure and characteristics. 


B Feedback equivalence of flexible joint robots to passive systems 

Here, we want to analyze the property of feedback equivalence of flexible joint robots to passive systems. 
To achieve this, we first present some definitions and results extracted from [5] and then apply the 
theorems to flexible joint robots. 

B.l Feedback equivalence of nonlinear systems to passive systems 

Consider a nonlinear system H described by equations of the form 

x = f(x) + g{x)u 
= h(x) 


y 
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(B.l) 

(B.2) 


with state space X = R* 7 , set of input values U = R m and set of output values Y = R m . The set U 
of admissible inputs consists of all {/-valued piecewise continuous functions defined on R. / and the m 
columns of g are smooth (i.e. C°°) vector fields and h is a smooth mapping. We suppose that the vector 
field / has at least one equilibrium; without loss of generality, we can assume /( 0) = 0 and h{ 0) = 0. 

Definition B.l By regular static (i.e. memoryless) state feedback, we mean a feedback of the form 

u = a(x) + 0(x)v (B.3) 

where a(x) and /?(x) are smooth functions defined either locally near x = 0 or globally, and 0{x) is 
invertible for all x. 

Definition B.2 The system represented by (B.l, B.2) is feedback equivalent to a passive system if there 
exists a regular static state feedback (B.3) such that the closed loop system 

x = [/(x) + </(x)a(x)] + g(x)(3(x)v 

y = h( x ) 


is passive . 

Definition B.3 A system of the form (B.l) is said to have relative degree {l, •••,!} at x = 0 if the 
matrix L g h( 0) is nonsingular. 

In Definition B.3, we use the following notation [13]: 



dh(x ) 

dx{ 


9i ( x ) 


where g t (x) = Eig(x) with E, 6 R mXm has element i, i equal to one, and all its other elements equal 
zero. 

The relative degree is also equal to the smallest order of time derivative of the output in which the input 
appears explicitly. 

Definition B.4 The distribution A spanned by the vector fields g\ (x), • ■ ■ , <7 m (x) 25 involutive if } for 
gi,gj € A, the Lie bracket 

[3i, 9i\ = j*9i - J^9i € A for = 

This is equivalent to say that 

rank {g\(x), • * = rank {3i i£?]} f OT ^ 3 = li " m 


If system (B.l, B.2) has relative degree {1, • - , 1} at x = 0 and the distribution A spanned by the vector 
fields g\ (x), ■ * • , 5 m (x) is involutive, it is possible to find q — m real- valued functions Z \ (£) ? * * *> 
locally defined near x = 0 and vanishing at x — 0, which, together with the m components of the 

output map, qualify as a new set of local coordinates. In the new set of coordinates (z, y) the system is 

represented in its normal form 

z = q(z,y) (B.4) 

ij = b(z, y) + a(z,y)u (B.5) 

where the matrix a(z,y ) is nonsingular for all z,y near (0,0). 
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The zero dynamics of a system describe those internal dynamics which are consistent with the external 
constraint y = 0. If a system has relative degree { 1 , • • • , 1 } at x = 0, its zero dynamics exist in a 
neighborhood X° of x = 0, evolve on the smooth (q - m)-dimensional submanifold 

Z' = {xe X° : h(x) = o} 

and are described by a differential equation of the form 

x = / (x) x € Z 

in which /*(x) (the zero dynamics vector fields) denotes the restriction to Z* of the vector field 

f{x) = f(x) + g(x)u{x) 

with 

u(x) = -[L g h(x)}- l Lfh(x) 

In the normal form (B.4,B.5) the zero dynamics are characterized by the equation 

i = g(z,0) 

In order to have a globally defined normal form, the following conditions must be satisfied: 

HI : the matrix L g h(x) is nonsingular for each x £ X, 

H2 : the vector fields g\{x) • • ■ g m ( x ) (defined below) are complete, 

H3 : the distribution spanned by < 7 i(x) • • • g m ( x) is involutive, 

where 

[&(*) ' * * 9m(x)] = 9(x) [L g h{x)]- 1 

Note that by complete, we mean that the integral curves are defined for all t > 0 for any initial conditions. 

Definition B.5 A nonnegative function V : X -* R is said to be proper if for each a > 0, the set 
V r “ 1 ([0,a]) = {x € X : 0 < V(x) < a} is compact. 

Definition B.6 Suppose L g h{ 0) is nonsingular. Then E is said to be: 

i) minimum phase if z = 0 is an asymptotically stable equilibrium of <?(z,0), 

ii) weakly minimum phase if there exists a C k , k > 2, function W'{z) } defined near z = 0 with W\ 0) = 0, 

which is positive definite and such that L q ^ z ^W (z) < 0 for all z near z = 0. 

Suppose Hi, H2 and H3 hold. Then E is said to be: 

i) globally minimum phase if z = 0 is a globally asymptotically stable equilibrium of q(z,0) 9 

ii) globally weakly minimum phase if there exists a C k , k > 2, function W ( 2 ), defined for all z with 

PF*(0) = 0, which is positive definite and proper such that L q ^ z ^W (z) < 0 for all z. 

Definition B.7 A point x° is a regular point for a system E of the form (B.l) if rank {L g h(x)} is 
constant in a neighborhood of x° . 
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Also, we assume that rank {<7(0)} = rank {dh( 0)} = m. 

We can now state the main theorems relating feedback equivalence of nonlinear systems to passive 
systems. 

Theorem B.l [5] Suppose x = 0 is a regular point for £. Then £ is locally feedback equivalent to a 
passive system with a C 2 storage function V, which is positive definite, if and only if £ has relative degree 
{1, ■ • 1} at x = 0 and is weakly minimum phase. 

Theorem B.2 [5] Assume HI, H2 and H3. Then £ is globally feedback equivalent to a passive (respec- 
tively, strictly passive) system with a C 2 storage function V, which is positive definite, if and only if E 
is globally weakly minimum phase (respectively, globally minimum phase). 

B.2 Flexible joint manipulators 

We now find the conditions under which a manipulator with flexible joints is feedback equivalent to a 
passive system, i.e. under which Theorem B.l or B.2 is satisfied. 


First consider the general model of a manipulators with flexible joints (3.10) repeated here for complete- 
ness 

- i r 

0 i 

0m 


M n ( 0 i, 0 m ) M 12 ( 0 e, 0 m ) 
M? 2 ( 0 ( , 0 m ) M 22 ( 0 m ) 


Cn( 0 t, 0 m , 0 e, 0 m) C l 2 ( 0 ( , 9 m 7 7 ) 1 J 9 . t 

C 2 l ( 9 ^ 9 m ^ 9 ^ 9 m ) ^22(^7^7717^7^771) _ _ 


+ 


De( 0 () 

_L 

r i( 0 e, 0 m) 


’ 0 ' 

_ D m ( 0 m ) _ 

T 

r 2 ( 0 e, 0 m ) 


I 


(B-6) 


First, write (B.6)in the form of (B.l, B.2), i.e. define 

T T T T T] T 
X = [ x[x I 2 x 3 x 4 j 

x 1 — 9 1 X2 = 9 m 


X 3 — 9 1 X 4 — ^71 


P 1 


C\\ 

C 12 


Xi 

1 

' D t ' 

_L 

7-1 

P2 


C 2 \ 

C 22 


. z ’ 2 . 

T* 

Dm 

i - 

. T2 - 


where the state dependence has been dropped, and use the fact that M\\ is nonsingular (in fact so is 
M22) to write the inverse of the mass matrix as 


A/" 1 = 


M~ l + M-KMnA^MnMu 


where 


rT \ f r - 1 


-1 


A 2 = M22 M 12 A/u M\2 

We may then write, after some simple manipulations, 


’ ' 


' - [Mfj 1 + 

P\ + M u l M l2 A 2 l p 2 


—M u l M\ 2 A 2 1 


X 2 



A 2 l p 2 

+ 


U 

±3 


X 1 



0m x m 


i 4 ^ 


^2 



OttiXtu 



Consider the case where the output is a linear combination of the state and is given by 

y = h(x ) = [ Ci C 2 C 3 C 4 


46 


where C u C 2 , C 3 , C 4 6 R mxm 


are constant. 


We readily verify that rank {g(0)j = m for any arm configuration since A 2 is always nonsingular. We 


will impose the constraint on h(x) that rank (d/i(0)} = m, i.e. the vector C\ Ci C3 C 4 


has rank 


m. 


First, find conditions on the output matrix such that the system has relative degree {1, • ■ 1} at x = 0. 

Write 


Lgh(x) 


dh{x) 

dx x 




+ 


dh(x) 

di2 


A 


-1 

2 


+ C 2 ] AJ 1 


Fact B.l Since the matrix A2 is nonsingular for any state value, the system has relative degree {1, • ■ ■ , 1} 
at x — 0 if and only if the matrix $ = C\M XX A/12 + C2] is nonsingular for x = 0. 


NOTES : 


• For any arm configuration, the presence or absence of the motor and link positions in the output 
does not affect the conclusion of Fact B.l. 

• If there is no gyroscopic coupling, i.e. A/12 = 0 , then C 2 must be nonsingular, i.e. the motor 
velocities must appear at the output, and C\ is arbitrary. 

• If A/12 is nonsingular for any state value, choosing the output as the link velocities with C\ non- 
singular is sufficient to guarantee that $ is nonsingular since M\\ is nonsingular for any state 
value. 

• If A/12 is not zero at x = 0, then $(0) is singular only for specific combinations of C\ and C 2 . 


The point x = 0 is regular if ranfc{$} = m in a neighborhood of x = 0. This is guaranteed by the 
continuity of Mu and A/12 if $ is nonsingular at x = 0. This holds globally (condition Hi) for proper 
choices of C\ and C 2 for any arm configuration due to the boundedness of Mu and A/12, i.e. if we choose 
Ci and C2 such that 

sup (T max {CiA/n (X3,X 4 ) -1 A/12 (^3,^4)} < ffmin {C 2 } 

This holds in particular if C\ = 0 or M\ 2 = 0 , and C 2 is nonsingular. 


We now proceed to show the (weak) minimum phase property. The zero dynamics of the system are 
described by the following equation : 


x = f(x) — g(x)[L g h(x)] 1 Lfh(x) x € Z 


= /W-ffW’jc, c 2 c 3 c 4 ]f(x) xez’ 

assuming that $ is nonsingular in the neighborhood of x = 0 . After some manipulations, this leads to 


x — 


— + M u 'Mi2* l C\M u l p\ + M n l M\2$ 1 [C3X1 + C4X 2] 

Q-'CiMrfpi - [C 3 xi + C 4 x 2 ] 


x 6 Z 


We consider two cases here while keeping in mind that we must satisfy $ nonsingular. We define the 
output as a function of the motor state only for the first case, and of the link state only in the second 
case. 
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Case 1 : Ci = C 3 — 0, C 2 nonsingular, C 4 nonzero. 


The dynamics on the zero manifold are described by 


-Mu 1 Pi + M~ l Mi 2 Ci l C 4 x 2 
-C^ a C 4 x 2 
x\ 

x 2 


x G Z — t C 2 x 2 + C4X4 — 0 j 


Setting the output to zero, we get 

C 2 X 2 “I" C 4 X 4 — 0 

X 2 ■ == ~ — C*2 CJ 4 X 4 

Hence, if C 2 l C 4 > 0 then x 4 -+ 0 exponentially; if C 4 = 0 then x 4 is a constant; in general, x 4 — null 
space of C 2 l C 4 > 0. 

NOTE : With the output of the system defined as the output of a exponentially stable first order 
exosystem with the motor position as its input, zero system output implies that the motor state goes to 
zero. If the exosystem is just stable, then we can only guarantee that the motor position will go to a 
constant. 


Given that the motor position x 4 converges exponentially to a constant x 4 j and the motor velocity x 2 to 
zero, the question of stability of the zero-dynamics resumes to analyze the stability of 


ii 
S3 

__ -A/ 1 ^ 1 (x3,* 4 /)[C'ii(a:3>*4/,*i»0)xi + D e (xi) + ri(x 3 ,x 4 /)] 

x x 



-Mu 1 Pi 




x 2 — 0) x 4 — - x 4 j 


This equation has the same stability properties as a rigid robot with a constant forcing term in x 4 /. 
Hence, consider the following scalar function 

V(xi,x 3 ) = ^xjMu(x 3 ,x 4 f)xi + tf(x!,x 3 ) (B.7) 

r* 3 

U(x i,x 3 ) = / *■,(£, x 4 /)df 

Jo 

U(x i,x 3 ), and thus F(xi,x 3 ), is positive definite if the equivalent torsional spring is strong enough with 
respect to gravity, i.e. if 

N V X3 k\ (#3, <£ 4 /) ^ ^4/) *^4/ £ R 


for r* defined as in (3.11) with x 4 ) monotonically increasing in £3, and fci(0,0) — <7^(0, 0) — 0. 

Represent the centrifugal and Coriolis matrix using Christoffel’s symbols such that (|M - C) is skew 
symmetric, which also imply that — Cn) is skew symmetric. Then, take the time derivative of 

(B.7) to obtain 

V(x u x 3 ) = -xJD ( (x 1 ) 

such that, for positive or at least non negative damping, V < 0. Hence, we conclude that the zero 
dynamics of the system are stable, and that the system is at least weakly minimum phase (Definition 

B.6). 


NOTE : If there is positive link damping then we conclude that xj — - 0 as well as its higher derivatives, 
such that the system equation becomes 


0 = r x (x 3 ,i 4 /) 
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which defines the steady state value(s) of x 3 , i.e. the system is stable and weakly minimum phase. 

With or without damping, if C 4 is nonsingular such that x 4 j = 0, then the zero state is asymptotically 
stable such that the system is minimum phase (Definition B.6). 

In conclusion, the conditions of Theorem B.l are satisfied, i.e. the system is locally feedback equivalent 
to a passive system, for the output containing only the motor state, i.e. if 

y = C?9 m + C 4 9 m 


• if and only if 

* ranklC?} = m such that rank{dh(0)} = m, and such that the system has relative degree 
{l, • • •, 1} and is regular at any point in the state space, 

♦ C^ l C 4 > 0, i.e. stable exosystem, 

• and if the spring is stiff enough compared to gravity and the link damping is at least positive 
semi-definite such that the system is weakly minimum phase. 


Case 2 : C? = C 4 = 0, C\ nonsingular, C 3 nonzero. 

We must first assume that M\? is nonsingular to guarantee that $ is invertible. 


The dynamics on the zero manifold are described by 


x 


-Cf'Csx 1 

-Mr? 1 PI + MgMuCt'CiX! 

Xl 

x 2 


X € z' = {x € X° : CxXi + C 3 x 3 = 0 } 


Setting the output to zero, we get 


C\X\ + C 3 x 3 — 0 

x\ = —Cr l C 3 x 3 

Hence, if Ci _1 C 3 > 0 then x 3 — 0 exponentially; if C 3 = 0 then x 3 is a constant; in general, x 3 — null 
space of Cr l C 3 > 0. 

NOTE : With the output of the system defined as the output of a exponentially stable first order 
exosystem with the link position as its input, zero system output implies that the link state goes to zero. 
If the exosystem is just stable, then we can only guarantee that the link position will go to a constant. 

Given that the link position x 3 converges exponentially to a constant x 3 j and the link velocity x j to zero, 
the question of stability of the zero-dynamics resumes to analyze the stability of 


*2 


f 

rH 

CL 

1 

1 

X4 


*> J 


xi = 0; x 3 = x 3 / 


-M 12 1 (x 3 /,X 4) [Ci2(z 3 /,X4,0,x 2 )x 2 + r 1 (x 3/ ,x 4 )] 

x? 


Hence, the stability of the zero dynamics of the system depends on the stability of the gyroscopic coupling 
subsystem (note that M\? may be positive definite, negative definite or indefinite (and also zero)). If 
this subsystem is stable, then so are the zero dynamics. With the assumption that rj is defined as 
previously and that fci(x 3 ,X 4 ) is monotonically decreasing with x 4 , this imposes the condition that 
Mi?(x 3 j, x 4 ) > 0 Vx 3 /, x 4 6 R m . Also note that if the motors have symmetric inertia, C \? is independent 
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of x 2 and is thus zero in this case such that we can get Lyapunov stability only (which is still sufficient 
to guarantee the system to be weakly minimum phase). 

In conclusion, the conditions of Theorem B.l are satisfied, i.e. the system is locally feedback equivalent 
to a passive system, for the output containing only the link state, i.e. if 

y — CiOt + Cz^i 


if and only if 

• M \2 is nonsingular, 

• rank {C\} — m such that rank{dh{ 0)} = m, and such that the system has relative degree {1, * • *, 1} 
and is regular at any point in the state space, 

• C^ l Cz > 0, i.e. stable exosystem, 

• the subsystem representing gyroscopic coupling is stable. 


We have established some conditions to obtain feedback equivalence to a passive system by using uniquely 
the motor or the link state. The same method may be used to analyze other choices of output, but this 
analysis is not carried out at this point due to the difficulty in verifying the stability of the reduced 
system describing the zero-dynamics. 

In case 1 previously presented, the minimum phase or weak minimum phase properties are in fact global. 
No such conclusion can be drawn for case 2 under the actual assumptions. Also, the two previous cases 
also satisfy condition Hi. Hence, only conditions H2 and H3 have to be verified to obtain global results 
using Theorem B.2. 

To verify H2, evaluate g(x) : 


g{*) 


-Mil 

0 

0 


such that the integral curves are defined for all t > 0 and for all initial conditions provided that $ is 
nonsingular over the complete state space. 

To verify H3, note that the Lie bracket [g^g 2 ] - 0, Vi,j = l,***,m so that (B.4) is verified, i.e. H3 is 
satisfied without additional conditions. 

Hence, in order to conclude on global equivalence, the only additional condition to verify with respect to 
the local case is the global asymptotic or global stability of the zero dynamics, e.g. conditions regarding 
damping in case 1 previously analyzed. 
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